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ABSTRACT 

A  scheme  to  locate  emitter  positions  using  post  flight 
processing  of  discrete  airborne  emitter  bearing  angles-of- 
arrival  information  and  recorded  aircraft  position  coor- 
dinates by  Kalman  filter  techniques  is  developed.   The 
signal  intercept  system  was  assumed  to  be  operating  in  a 
multi-emitter  environment  and  all  data  was  sampled  at 
discrete  but  time  varying  intervals.   The  aircraft  position 
data  is  filtered  directly  in  latitude  and  longitude  and 
emitter  locations  are  computed  in  latitude  and  longitude 
using  vector  methods.   An  extended  Kalman  filtering  scheme 
is  developed  to  compute  emitter  coordinates  directly  in 
latitude  and  longitude  coordinates . 
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I.   INTRODUCTION 

With  the  ever  increasing  reliance  of  the  military  forces 
on  electromagnetic  systems  for  communication,  reconnais- 
sance, and  weapons  control,  there  is  a  correspondingly 
increasing  requirement  to  detect  and  locate  the  position  of 
the  enemy  emitters. 

The  complexity  of  this  problem  was  shown  by  F.  Pfendtner 
in  [1] .   When  there  are  multiple  emitters  in  reasonable 
proximity  and  several  observations ,  called  direction  finding 
(DF)  bearings,  are  made,  the  number  of  possible  locations  I, 
of  these  emitters  is  found  by 

I  =  m2n(n-l)/2 

where  m  is  the  number  of  emitters  and  n  is  the  number  of 
observations . 

If  there  were  six  emitters  and  ten  observations  of  each 
emitter,  there  would  be  a  possibility  of  1,620  points  of 
bearing  line  intersections,  each  a  valid  emitter  position. 

A  scheme  was  developed  in  [1]  to  locate  the  most  prob- 
able location  of  the  emitter  based  on  the  mean  of  all  points 
of  intersection  associated  with  a  given  target.   This  scheme 
did  not  provide  the  desired  degree  of  accuracy.   So,  a 
scheme  was  developed  to  Kalman  filter  all  of  the  DF  bearing 
correlated  with  a  given  target,  thus  finding  an  optimal 
estimate  of  these  observations.   The  first  and  last  estimates 


of  the  DF  bearings  to  each  target  were  used  to  determine 
emitter  location  by  triangulation  methods.   This  scheme 
provided  solutions  much  closer  to  the  desired  accuracy. 

Any  solution  is  only  as  good  as  the  data  used  to  compute 
it,  so,  L.  L.  Coburn  developed  a  data  sort  scheme  in  [2] 
which  would  compare  all  of  the  observations  and  correlate 
each  data  point  with  a  specific  target  to  avoid  the  pos- 
sibility of  basing  the  solution  of  an  emitter  position  on 
observations  not  from  that  target.   The  sort  was  based  on 
signal  carrier  frequency  and  pulse  repetition  frequency, 
PRF.   The  data  sort  utilized  in  [2]  was  only  an  initial  sort 
in  that  any  observations  not  passing  a  later  comparison  test 
were  discarded  and  not  saved  for  locating  further  emitter 
sites. 

In  this  study  an  initial  data  sort  based  on  signal 
carrier  frequency  and  PRF  is  utilized,  but  all  observations 
are  eventually  correlated  to  a  target  or  are  labeled  as 
single  line  bearings. 

Also  for  this  report  a  routine  was  developed  to  deter- 
mine Optimal  estimates  of  aircraft  position  coordinates  by 
filtering  and  smoothing  aircraft  position  observations. 

An  extended  Kalman  filter  was  developed  to  filter  the 
estimate  of  the  target  position  directly  in  latitude  and 
longitude.   This  routine  could  be  used  to  track  moving 
targets,  or  to  filter  emitter  positions  based  on  data  from 
several  flights.   Only  signal  parameters,  the  estimates  of 


aircraft  position,  observed  DF  bearing  angles,  time  data, 
and  the  estimated  target  position  would  need  to  be  stored 
from  each  flight  for  further  processing. 


II.   PROBLEM  DESCRIPTION 

A.   KALMAN  FILTER  THEORY 

Sequential  estimation  is  characterized  by  the  serial 
recursive  processing  of  observations  taken  in  time  sequence. 
The  result  of  every  processing  cycle  is  the  current  best 
estimate  of  the  vector  being  estimated.   This  estimate  there- 
fore embodies  all  observation  data  up  to  and  including  the 
current  observation.   As  a  new  observation  is  made,  the 
current  estimate  is  updated  to  reflect  this  most  recent  data. 

In  such  an  estimation  scheme  the  calculations  are  iden- 
tical in  nature  from  cycle  to  cycle  so  they  are  ideally 
suited  for  implementation  on  a  digital  computer. 

The  problem  presented  in  this  report  is  that  of  the  post 
flight  processing  of  digitized  data,  but -the  program  utilized 
in  this  case  could  easily  be  adapted  for  a  real-time  proces- 
sor for  in-flight  computing  and  real-time  locating  of  emitter 
sites. 

The  Kalman  filter  [3]  is  a  recursive  filter  of  the  type 
needed  for  this  application.   Since  the  data  inputs  are 
already  in  digital  form,  the  discrete  form  of  the  Kalman 
Filter  are  utilized  for  processing  on  a  digital  computer. 

From  the  probabilistic  description  of  the  random  signal 
and  noise  we  can  determine  the  probability  with  which  a 
particular  sample  of  the  signal  and  noise  will  occur  and  we 
can  therefore  estimate  x(k).   This  estimate  will  be  denoted 
by  x(k) 


The  discrete  system  under  consideration  satisfies 


x(k+l)  =  (j»(k)x(k)  +  w(k) 


z(k)  =  h(k)x(k)  +  v(k) 


(1) 


(2) 


where  x  is  an  n  x  1  state  vector,  z  is  an  m  x  1  output  vec- 
tor, w  is  a  zero-mean  n  x  1  vector  of  state  excitation 
white  noise,  uncorrelated  with  the  zero-mean-additive 
observation  white  noise  vector  v,  <j>  is  the  state  transition 
matrix  and  h  is  the  observation  matrix.   The  noise  statis- 
tics are 


v(k)  v(j)T  =  R(k)  5(k,j) 

[• 


E  w(k)  w(j) 


=  Q(k)  6(k,j) 


[• 


Elv(k)  w(j)T 


6(k,j)  = 


=  0   for  all  (k,j) 

0  k^j 

1  k  =  j 


(3) 
(4) 
(5) 

(6) 


The  Kalman  filter  recursion  equations  [4]  are  summarized 
below  where  X(k|j)-  denotes  the  estimate  of  the  state  X(k) 
based,  upon  j  measurement  observations  Z  (1) ,Z  (2) , . .  .  ,Z  ( j)  . 

P(k|k-1)  =  <J>(k/k-l)P(k-l|k-l)c|>(k/k-l)T+Q(k)      (?) 


[■ 


G(k)  =  P(k|k-l)H(k)  H(k)P(k|k-l)H(k)  +R(k) 


P(k|k)  =  P(k|k-1)  -  G(k)H(k)P(k|k-l) 


-1 


X(k|k)  =  X(k|k-1)  +  G(k) 


Z(k)  -  H(k)X(k|k-l) 


X(k|k-1)  =  <}>(k,k-l)X(k-l|k-l) 


(8) 


(9) 


(10) 


(ID 
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where  G(k)  is  the  Kalman  filter  gain  matrix  and  P  (k | j )  is 
the  error  covariance  matrix. 

B.   SYSTEM  MODELS 

The  emitter  position  locating  system  modeled  was  divided 
into  three  distinct  systems,  (1)  aircraft  navigation  system, 
(2)  the  DF  bearings,  and  (3)  the  target  location.   The 
combined  system  consists  of  five  linear  Kalman  filters ,  plus 
one  linearized  Kalman  filter,  called  an  extended  Kalman 
filter,  and  two  smoothing  filters.   Each  of  these  models 
will  be  described  briefly  in  this  section  with  more  detailed 

descriptions  in  Section  III,  "Computational  Procedures." 

2 

All  of  the  systems  are  modeled  by  a  linear  1/s   plant. 

The  state  transition  matrix,  <£,  is 


<Mk+l,k) 


1    T(k+1) 
0      1 


(12) 


where  T(k+1)  =  TIME  T(k+1)  -  TIME  T(k),  TIME  T  being  the 
time  of  observation. 

To  minimize  the  affects  of  the  inherent  uncertainty  of 
the  system  model,  the  values  of  Q  should  be  increased  to  a 
value  which  ensures  that  each  observation  is  utilized.   The 
effect  of  increasing  the  magnitude  of  Q  is  seen  from  (7)  to 
be  larger  values  of  the  error  covariance  matrix,  P,  which 
leads  to  an  increase  in  the  filter  gain  matrix  G.   This 
means  that  the  filter  is  paying  more  attention  to  the  actual 
measurement  to  compensate  for  errors  in  the  plant  model. 
Thus,  the  more  nonlinear  the  system  dynamics,  the  larger  Q 
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should  be.   If  the  measurement  errors  are  in  question,  R 
should  be  increased  which,  as  can  be  seen  from  (8) ,  will 
decrease  G  so  the  filter  relies  more  on  the  total  effect  of 
all  previous  measurements,  i.e.  the  previous  estimate  of  the 
system  states  [5]  . 

1 .   Aircraft  Navigation  System  Model 

The  navigation  system  is  modeled  by  a  constant  velo- 
city plant  for  each  direction  of  aircraft  travel,  east-west 
and  north-south,  with  the  system  states  for  each  plant  being 
aircraft  position  and  aircraft  velocity.   Only  the  aircraft 
position  fixes  were  observable  so  the  objective  of  this 
filter  is  to  filter  the  noisy  observed  position  coordinates 
to  obtain  optimal  estimates  of  own  aircraft  location.   These 
estimates  are  used  in  processing  the  DF  bearings  and  target 
positions. 

Since  only  aircraft  position  coordinates  were  observed, 
the  observation  matrix  is  H  =  [1   0].   This  made  W(k),V(k) 
and  R(k)  scalar  variance  terms  and  the  bracketed  terms  in  (8) 
and  (10)  become  scalar  as  well. 

Since  W  is  a  scalar,  (4)  becomes 

te[w  wt]  rT|  =  r  rT  e[w21.  (13) 

Substituting  the  expression  for  r  into  (13)  yields 


rT4(k)    T3(k) 


Q(k)  =  e[w2J 


T3(k)    m2 


2 
T'(k) 


(14) 
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2.  DF  Bearing  Model 

The  system  states  for  the  problem  of  angle  filtering 
are  DF  bearing  angle-of-arrival  and  bearing  rate.   In  this 
program  the  system  dynamics  are  also  modeled  by  a  constant 
velocity  plant.   The  bearing  rate  is  unobservable  so  the 
observation  matrix  is  H  =  [1    0]  as  in  the  navigation  data 
filter  equations. 

This  model  does  not  accurately  represent  the  actual 
system  since  the  estimated  angular  rate  error  increases  with 
time[l].   However  by  introducing  a  non  zero  Q  matrix  this 
error  can  be  reduced.   The  effect  of  Q  on  the  accuracy  of 
this  model  can  be  seen  in  the  results  obtained  by  L.  L. 
Coburn  [2] . 

3.  Target  Position  Coordinates  Model 

The  states  of  the  target  location  system  are  lati- 
tude, latitude  rate,  longitude,  and  longitude  rate  while  the 
observations  are  the  noisy  DF  bearings  only.   To  compute  the 
optimal  estimate  of  the  states,  the  system  was  modeled  by 
two  linear  constant  velocity  systems,  one  each  for  latitude 
and  longitude.   A  linearized  transformation  of  the  measure- 
ment equation  was  utilized  to  provide  DF  bearing  information 
to  the  latitude  and  longitude  filters  in  a  form  they  could 

use  to  filter  their  states. 

2 

The  models  for  the  two  linear  systems  are  again  1/s 

plants  with  H  =  [1   0] . 

The  target  location  system  model  is  shown  in  Fig.  1, 
and  is  discussed  further  in  Section  III,  part  F,  "Extended 
Kalman  Filter." 
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C.   SMOOTHING 

Two  types  of  smoothing  are  utilized  in  this  program, 
fixed  point  with  the  angle  filter  and  fixed  interval  with 
the  navigation  data  filter.   The  fixed  point  smoothing  tech- 
nique will  be  discussed  first. 

1.   Fixed  Point  Smoothing 

In  the  process  of  angle  filtering,  the  estimate  of 
the  DF  bearing,  9(n|n),  is  a  weighted  "average"  of  all 
previous  noisy  DF  bearings,  6 (1) , 0 (2) , . . . , 0 (n) .   However  the 
actual  position  finding  algorithm  (POSIT)  utilizes  the  esti- 
mate of  the  first  DF  bearing,  0(l|n),  as  well  as  0(n|n). 
So,  the  first  bearing  should  be  somehow  weighted  by  all 
successive  cuts,  0  (2) , . . . ,0  (n) .   The  technique  used  to  accom- 
plish this  filtering  is  called  fixed  point  smoothing.   The 
smoothing  equations  are  similar  to  the  Kalman  filter  equa- 
tions in  that  they  are  recursive  in  nature  and  functions  of 
similar  statistical  parameters.   The  difference  is  that  the 
smoothing  filters  produce  a  previous  estimate  of  the  state 
subject  to  successive  measurements.   The  fixed  point  smooth- 
ing equations  used  in  this  program  are  summarized  below  [6] . 
a.   Gain  Equation 

X(k|j)  =  X(k|j-1)  +  W(j)H   (j)TR_1(j)  [z(j) 

-  H(j)<j>(j,j-l)X(j-l|  j-l)J  (15) 

where  j  =  k+1,  k+2,...,  and  the  initial  condition  is  X(k|k). 
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b.  Gain   Equation 

W(j)    =   W(j-l)<|>     (j,j-l)T    [l-S(j)P(j|  j)]  (16) 

where  W(k)    =   P(kjk)    and  S(j)    =   H  ( j)  TR~1  ( j)  H  ( j  ) 

c.  Covariance  Equation 

P(k|j)  =  P(k|j-1)  -  W(j)  [s(j)P(j|  j-l)S(j) 

+  S(j)]  W(j)T  ?  (17) 

where  the  initial  condition  is  P(k|k).   P(j|j)  and  P  ( j  j  j  —  1) 
are  the  error  covariance  matrices  from  the  optimal  filter. 
2 .   Fixed  Interval  Smoothing 

The  second  type  of  smoothing  utilized  is  the  fixed 
interval  smoothing.   In  the  navigation  data  filtering  routine, 
the  flight  track  is  broken  into  legs  with  a  new  leg  being 
initiated  any  time  the  aircraft  flies  for  more  than  two 
minutes  without  recording  a  position  fix.   Each  leg  is  then 
an  interval  and  each  interval  is  filtered  and  smoothed 
separately.   The  motivation  for  the  fixed  interval  smoothing 
routine  is  similar  to  that  for  smoothing  in  the  angle  filter- 
ing routine,  i.e.  each  estimate  should  be  influenced  by  each 
successive  measurement  as  well  as  by  each  previous  one.   The 
fixed  interval  smoothing  equations  utilized  in  the  angle 
filter  are  [6] .   Utilized  in  the  angle  filter  are  [6] : 

a.   Filter  Equation 

X(k|n)  =  X(k|k)  +  A(k)[x(k+l|n)  -  X(k+l|k)]   (18) 

for  k  =  n-l,n-2, . . . ,0,  where  X(n|n)  is  the  boundary  condition 
for  k  =  n-1. 
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b.  Gain   Equation 

A(k)    =   P(k|k)<|>    (k+l,k)TP_:L(k+l|k)  (19) 

c.  Covariance  Equation 

P(k|n)  =  P(k|k)  +  A(k)  [p(k+l|n) 

-  P(k+l|k)J  A(k)T  (20) 

This  filter  has  the  advantage  taht  it  incorpor- 
ates the  covariance  terms,  P(k|k)  and  P(k+l|k),  as  well  as 
the  estimates  X(k|k)  and  X(k+l|k)  from  the  Kalman  filter 
equations,  so  the  required  number  of  computations  is  mini- 
mized.  Since  k  =  n-1,  n-2,...,0,  it  is  clear  that  this 
system  of  equations  is  recursive  backwards  in  time  so  it  does 
indeed  produce  a  smoothed  estimate  of  each  navigational  fix 
subject  to  all  successive  fixes  on  that  leg. 

D.   INITIAL  EMITTER  POSITION  FIXING 

Each  position  on  the  earth  can  be  considered  to  be  the 
tip  of  a  vector  whose  length  is  the  radius  of  the  earth. 

In  this  problem  the  radius  of  the  earth  is  assumed  to 
be  constant.   Even  though  it  is  known  that  the  constant 
radius  assumption  is  an  inaccurate  one,  using  a  constant 
value  for  the  radius  produces  an  error  of  less  than  two  per- 
cent of  the  distance  involved  anywhere  on  the  surface  of  the 
earth  [7],   Also  by  using  this  assumption  this  method  is 
equally  valid  over  the  entire  globe  without  regard  for  the 
radius. 

The  position  vector  can  be  described  either  by  its  lati- 
tude and  longitude  or  in  x,y,z  coordinates  on  a  three 
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dimensional  coordinate  system  with  the  center  of  the  earth 
as  the  origin  of  the  system,  as  in  Fig.  2. 

The  latitude  is  the  angle  in  a  meridian  plane  measured 
from  the  equatorial  plane  to  the  radius  vector  of  the  air- 
craft.  Longitude  is  the  angle  in  the  equatorial  plane 
measured  from  the  Greenwich  meridian  to  the  meridian  of  the 
aircraft.   The  latitude  of  a  point  on  the  earth  is  in  the 
range  0  to  90  degrees  in  the  northern  hemisphere  and  from  0 
to  -90  degrees  in  the  southern  hemisphere.   The  longitude  of 
a  point  on  the  earth  is  in  the  range  0  to  180  degrees  in  the 
eastern  hemisphere  and  from  0  to  -180  in  the  western  hemis- 
phere.  In  the  3-D  right  hand  coordinate  system  the  positive 
2  axis  passes  through  the  geographic  north  pole,  the  positive 
~x  axis  passes  through  the  Greenwich  meridian  and  lies  in  the 
equatorial  plane  and  the  positive  y  axis  passes  through  90 
degrees  east  longitude  and  lies  in  the  equatorial  plane  [8]. 

The  relationship  between  the  latitude  and  longitude 
coordinates  (<j),6)  and  the  (x,y,z)  coordinates  is  expressed 
by  the  formulae 

x  =  cos<)>  cos0  (21) 

y  =  cos<{>  sinG  (22) 

z  =  sintf)  (23) 

From  vector  algebra  we  know  that  when  two  vectors  are 
multiplied  together  vectorially  the  resultant  is  called  the 
cross  product.   The  resultant  is  another  vector  whose  direc- 
tion is  perpendicular  to  the  plane  of  both  of  the  original 
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Figure  2.   Illustration  of  Relation  Between  Station  (<f>,0) 
and  (x,y,z)  coordinates. 
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vectors  and  is  called  the  normal  vector.   Therefore  if  the 
aircraft  position  vector  is  crossed  into  the  vector  normal 
to  the  DF  bearing  plane,  a  normal  vector  parallel  to  the 
surface  of  the  earth  is  produced.   This  multiplication  is 
carried  out  for  the  smoothed  initial  DF  bearing,  9(l|n),  and 
the  filtered  last  bearing,  9(n|n).   Then  if  the  bearing 
vectors  are  assumed  parallel  to  the  surface  of  the  earth  at 
the  target  position,  their  cross  product  will  produce  a 
vector  through  the  center  of  the  earth  at  their  point  of 
intersection.   This  vector  is  the  position  vector  of  the 
target. 

The  assumption  of  the  DF  bearing  being  parallel  to  the 
earth's  surface  at  the  target  and  at  the  position  of  the  air- 
craft can  be  easily  understood  when  it  is  realized  that  the 
bearing  vector  is  actually  the  projection  of  the  plane  con- 
taining the  DF  bearing  onto  the  surface  of  the  earth. 

The  difficulty  of  the  vector  method  arises  when  an 
attempt  is  made  to  describe  the  bearing  vector  in  an  earth 
centered  cartesian  coordinate  system  so  the  cross  product 
can  be  obtained.   This  description  is  found  by  a  series  of 
three  coordinate  system  rotations.   The  resultant  of  a  suc- 
cession of  coordinate  system  rotations  is  simply  the  dot 
product  of  the  coefficient  matrices  of  each  rotation  [1] 
and  [9]. 

The  rotations  made  in  this  program  are  shown  in  Figs.  3, 
4f  and  5.   The  original  coordinate  system  is  denoted  (i,j,k), 
after  the  first  rotation  (i*,j*,k*),  after  the  second 
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Figure  3.   Rotation  of  Axes  about  j  Axis 
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Figure  4.   Rotation  of  Axes  about  k*  Axis 


21 


k** 


k*** 


i** 


*** 


Figure  5.   Rotation  of  Axes  About  Local  Vertical. 
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rotation  (i** , j**,k**) ,  and  after  the  third  rotation 
(i***,  j***^***)  ,   The  first  rotation  about  the  negative  j 
axis  is  expressed  as 


(24) 


The  second  rotation  is  about  the  k*  axis  and  is  represented 
by 
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(25) 


The  resultant  of  the  first  two  rotations  is  a  target  centered 
coordinate  system  expressed  in  cartesian  coordinates.   In 
this  coordinate  frame,  i**  is  local  vertical,  j**  is  local 
west  and  k**  is  local  north. 

The  third  rotation  is  a  rotation  by  -a  about  the  i** 
axis  (local  vertical)  which  after  making  simplifying  trig- 
onometric substitutions  is 


10      0 
0    sina   cosa 
0   -cosa   sina 


-;  ** 
k** 


(26) 


Since  k***  is  the  unit  vector  in  the  bearing  plane,  j*** 
is  the  normal  to  the  bearing  plane  and  after  carrying  out 
the  indicated  matrix  multiplications,  is  expressed  in  terms 
of  the  original  coordinates  as 
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N  =  j***  =  (-sinasin8-cosasin<}>cos0)  i 
+  (sinacos9-cosasin4>sin6)  j 
+  (cosacosiJ))k.  (27) 

Then  by  cross  multiplying  the  aircraft  position  vector 
associated  with  N,  into  N,  the  vector  which  represents  the 
DF  bearing  vector  is  determined.   This  method  was  utilized 
in  developing  subroutine  POSIT  which  is  discussed  in  Appen- 
dix C. 

E.   EXTENDED  KALMAN  FILTER 

Since  the  Kalman  filter  is  optimum  only  when  the  system 
differential  equations  and  measurements  are  linear,  a  rela- 
tionship had  to  be  found  to  linearize  the  nonlinear  measure- 
ments associated  with  emitter  locating.   The  sought  for 
relationship  can  be  obtained  by  a  Taylor  series  expansion  of 
the  target  location.   This  series  expansion  of  the  nonlinear 
measurements  can  be  substituted  for  the  coefficient  matrices 
in  the  Kalman  filter  recursive  gain  equations  and  computation 
then  proceeds  just  as  in  the  discrete  algorithm  as  described 
previously  in  this  report.   This  employment  of  the  Kalman 
filter  is  frequently  referred  to  as  the  "Extended  Kalman 
Filter."   It  is  an  intuitive  but  frequently  successful  appli- 
cation of  the  Kalman  filter  in  the  absence  of  truly  optimum 
filters  for  non-linear  systems  [10]. 

These  techniques  are  only  approximate.   They  require 
that  the  disturbances,  measurement  noises,  and  uncertainties 
in  the  state  be  of  such  a  size  that  the  higher-order  terms 
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ignored  in  computing  the  error  are  insignificant.   It  was 
felt  that  for  this  system,  where  one  of  the  objectives  was 
simplicity  of  computation,  that  though  the  higher  order 
terms  are  existent  the  system  dynamics  model  used  was  a 
satisfactory  approximation  of  the  actual  plant  dynamics. 

In  the  case  of  emitter  locating  from  an  aircraft  using 
the  extended  Kalman  filter  routine,  we  are  actually  filter- 
ing in  latitude  and  longitude  while  our  observations  are 
noisy  DF  bearings  only,  i.e. 

Z(k)  =  6(k)  +  V(k)  .  (28) 

It  is  obvious  that  no  pseudo-cartesian  coordinates  can  be 
generated  from  this  measurement.   The  non-linear  measurement 
process  must  therefore  be  represented  by  a  linear  approx- 
imation. 

From  the  development  of  the  Kalman  filter  equations  [6] , 
it  can  be  seen  that 

X(k|k)  =  <}>(k,k-l)  X(k-l|k-l)  +  E[X(k|k)  |z(k)  ]    (29) 

Let  G(k)Z(k)  =  E[X(k|k)Z  (k)  ]  where  Z  (k)  =  M(k)  X  (k  |  k-1)  .   So 
the  estimated  measurement  equation  becomes 

Z(k)  =  9(k)  (30) 

where  [2] 

/  (X  -A)  cos  L  \ 
6(k)  =  TAN  x   — -  (31) 

\  LT  *  L     / 
where  AT  is  the  target  longitude,  X   is  the  aircraft  longi- 
tude, L   is  the  target  latitude,  and  L  is  the  aircraft 
latitude . 

25 


Substituting  this  expression  into  the  Kalman  filter 
equations,  the  recursive  filter  equation  becomes 

X(k+1)  =  <j>(k+l,k)X(k)  +  G(k)[6(k)  -  6  (k)  ]  .      (32) 


Expanding  the  measurement  equation 
6  =  M(A,L) 


(33) 


about  the  most  recent  optimal  estimate  and  ignoring  higher 
order  terms  results  in 


6  =  M(X*,L*)  + 


from  which  we  see  that 
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The  Kalman  filter  recursion  equations,  (7)  through  (11), 
may  then  be  rewritten  to  include  the  nonlinear  observation 
matrix  M,  and  are  given  by 

P(k|k-1)  =  <Mk,k-l)P(k-l|k-l)<{>  (k,k-l)T+  Q(k)    (36) 

G(k)  =  P(k|k-l)M(k)  [M(k)P(k|k-l)M(k)T+  R(k)]"1  (37) 

..'  P(k|k)  =  P(k|k-1)  -  G(k)M(k)P(k|k-l)  (38) 

X(k|k)  =  X(k|k-1)  +  G(k)  [z(k)  -  M(k)X(k|k-l)J   (39) 

X(k|k-1)  =  cf)(k,k-l)X(k-l|k-l)  (40) 
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III.   COMPUTATIONAL  PROCEDURES 

A.   NAVIGATIONAL  DATA  FILTERING  -  (SUBROUTINE  NAV) 

The  first  step  in  the  problem  of  finding  a  target  is 
that  of  filtering  the  aircraft  position  estimates.   Aircraft 
navigation  data  was  sampled  and  recorded  at  discrete  but 
time  varying  intervals.   As  stated  in  Section  II,  part  B.l, 
only  the  position  fixes  were  measured  so  the  velocity  is 
only  estimated  and  is  strictly  a  product  of  the  model  used 
to  represent  the  aircraft.   Since  the  aircraft  position  fixes 
were  taken  at  random  intervals,  there  are  extended  periods 
during  which  no  navigation  data  is  available  and  when  the 
flight  track  could  be  altered  drastically.   Therefore,  the 
flight  track  is  broken  into  legs  to  ensure  that  the  program 
does  not  attempt  to  filter  through  these  abrupt  changes. 

The  criteria  used  in  this  program  to  establish  the  end 
of  a  leg  is  a  simple  time  test.   If  T(k),  the  time  between 
navigation  fixes,  exceeds  120  seconds,  the  current  leg  is 
terminated  and  a  new  leg  is  initiated. 

If  a  leg  was  found  to  consist  of  three  or  fewer  data 
points,  that  leg  was  neither  filtered  nor  smoothed,  but 
rather  the  measured  data  was  used  for  the  filtered  and 
smoothed  estimate  of  position,  i.e.,  SLADSM (K) =ACLAD (K) .   No 
estimation  of  velocity  was  computed  for  these  legs.   After 
the  entire  flight  track  was  divided  into  legs,  the  Kalman 
filter  was  initialized. 
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The  navigation  data  filter  consists  of  two  nearly  iden- 
tical Kalman  filters,  one  to  filter  latitude  and  the  other 
for  longitude  filtering.   The  system  dynamics  for  the  air- 
craft are  modeled  in  each  direction  by  a  constant  velocity 
plant. 

Since  equal  angles  of  latitude  and  longitude  yield  equal 
distances  of  movement  only  at  the  equator,  a  correction 
factor  must  be  applied  to  angular  measure  as  either  pole  is 
approached  from  the  equator. 

At  60  north  latitude,  for  example,  one  degree  of  move- 
ment in  latitude  measures  sixty  nautical  miles  while  one 
degree  of  movement  in  longitude  only  measures  thirty 
nautical  miles.   This  requires  that  the  longitude  angular 
distance  be  corrected  by  the  cosine  of  the  local  latitude 
coordinate  so  that  the  two  filters  will  have  equal  units  of 
distance.   The  position  estimates  of  the  navigation  data 
filters  are  based  on  estimated  distances  traveled,  i.e. 

Xl(k|k)  =  Xl(k|k-1)  +  Xl(k|k-1)  T(k)  (41) 

The  estimated  changes  in  longitude  position  will  be  off  by 
a  value  of  1/cos  (latitude)  ,  so  (41)  was  modified  to 

x"l(k|k)  =  Xl(k|k-1)  +  Xl(k|k-1)  T  (k)  cos  (latitude)  (42) 

■  Equivalently,  Xl(k|k-1)  can  be  reduced  by  the  cosine  of 
the  latitude  directly,  which  is  the  method  used  in  this 
program.   The  equation  used  in  NAV  then  is 

VELED(K)=(VELED(KK)  +  G2  (K)  *ELON  (K)  )  *COS  (SLA  (K)  )     (43) 
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where  VELED  is  the  aircraft  velocity  east  in  degrees  per 
second,  G2  is  the  Kalman  filter  gain,  ELON  is  the  Kalman 
filter  error  term  and  SLA  is  the  latitude  coordinate  of  the 
aircraft.   The  same  correction  is  applied  to  the  smoothed 
XI (k)  term,  VELEDS ,  in  the  smoothing  filter. 

To  initialize  the  latitude  filter,  the  initial  position 
estimate,  SLAD(KI),  was  set  equal  to  the  first  measured 
position,  ACLAD(KI).   The  aircraft  velocity  was  not  observ- 
able, so  the  initial  velocity  was  estimated  by 

VELND(KI)= (ACLAD(KI+1)  -  ACLAD (KI ) ) /T (KI+1)      (44) 

where  T(KI+1)  is  the  time  increment  from  time  KI  to  time 
KI+1.   X(l|0)  was  assumed  equal  to  X(0|0)  so  SLATD(KI),  the 
predicted  value  of  SLAD,  was  also  set  equal  to  ACLAD (KI). 

The  longitude  filter  was  initialized  in  the  same  manner 
as  the  latitude  filter  with  the  only  change  being  that  the 
velocity  east  was  corrected  by  the  cosine  of  the  latitude 
to  correct  for  the  curvature  of  the  earth  as  discussed  above. 
Therefore 

VELED (KI)= ( (ACLOD (KI+1)  -  ACLOD (KI) /T (KI+1) ) 

X  COS (SLA (KI) )  (45) 

The  initial  uncertainty  of  position  and  velocity  on 
filter  initialization  was  accounted  for  in  the  initial  values 
of  the  error  covariance  matrix  P(l|o).   The  error  in  the 
initial  position  fixes  by  the  navigational  computer  were 
assumed  to  be  very  small  and  so  the  initial  covariance  matrix 
P(l|0),  was  set  equal  to  the  identity  matrix. 
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The  measurement  noise,  v,  is  assumed  scalar  so  by  (3) 

E[VvT]  =  R'  (46) 

The  value  of  R  will  change  for  each  system,  depending  upon 
the  accuracy  of  that  system,  but  it  is  assumed  constant  for 
each  data  set. 

The  smoothing  filter  is  recursive  in  negative  time  so 
the  first  estimate  of  position  computed  by  the  smoothing 
filter  is  the  next  to  the  last  fix  in  that  leg.   Therefore 
to  initialize  the  smoothing  filter,  the  first  smoothed 
estimate  SLADSM(N),  was  set  equal  to  the  last  filtered  posi- 
tion estimate  SLAD(N).   The  error  covariance  matrix  P,  used 
to  compute   the  smoothed  position  estimates  is  the  same 
matrix  computed  for  the  Kalman  filter,  so  there  was  no  P 
matrix  to  initialize. 

It  was  found  that  occasionally  the  aircraft  navigational 
computer  would  produce  a  totally  erroneous  position  fix,  to 
check  for  this  occurrence,  each  Kalman  filter  error  term, 
E(k)  =  Z  (k)  -  X(k+l|k),  was  checked  and  if  it  exceeded  a 
certain  value,  denoted  test,  the  data  point  was  rejected. 
The  estimate  of  the  state,  X(k+l|k),  was  inserted  as  the 
estimate  of  position,  i.e.  in  the  latitude  filter 

SLAD(K)=SLAD(K-1)  +  VELN  (K-l)  T  (K)  (47) 

The  equations  used  in  the  navigation  data  filter 
(SUBROUTINE  NAV)  are  derived  in  Appendix  A. 
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B.   ANGLE  FILTERING  -  (SUBROUTINE  GEORGE) 

After  the  navigation  data  is  filtered  and  smoothed  the 
processing  switches  to  subroutine  GEORGE,  which  is  basically 
the  program  presented  in  [2] ,   This  subroutine  sorts  the 
emitter  data  and  then  filters  and  smooths  the  DF  bearings. 

To  adapt  the  program  presented  in  [2]  ,  for  use  in  this 
problem,  the  data  sort  routine  was  changed,  a  new  smoothing 
filter  was  inserted  and  the  emitter  position  locating 
algorithm  was  replaced  by  a  vector  solution  method  which 
is  included  in  subroutine  POSIT. 

The  data  sort  used  in  this  program  is  shorter  than  the 
original  routine.   In  the  data  sort  routine,  the  error 
interval  associated  with  the  measured  values  of  signal 
frequency  and  PRF  was  opened  up  to  approximate  the  errors 
of  the  system  being  simulated.   This  test  interval  can 
easily  be  changed  to  any  desired  width  to  fit  the  system 
being  simulated. 

It  was  found  that  the  PRF  value  was  zero  in  some  data 
sets.   In  these  cases,  the  DF  bearing  associated  with  these 
particular  points  were  correlated  with  the  previous  signal 
with  the  same  carrier  frequency. 

All  of  the  DF  bearing  angles  are  checked  for  target 

correlation  as  in  [2] ,  but  instead  of  discarding  any  data 

2 
points  which  do  not  pass  the  test  E  (K) < (Pll (K)  + 

RCUT) *TSTCUT,  being  discarded,  they  are  assigned  to  a  new 

target.   RCUT  is  the  assumed  value  of  the  variance  of  the 

measurement  noise  v,  and  TSTCUT  is  a  multiplier  to  vary  the 
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size  of  the  gate.   This  routine  was  inserted  because  with 
the  method  used  in  [2]  ,  only  one  target  of  each  FREQ  and  PRF 
could  be  processed  from  each  data  set;  data  from  all  other 
similar  emitters  were  discarded. 

The  smoothing  routine  utilized  here  is  shorter  and  does 
not  require  the  computation  of  the  inverse  of  the  P  matrix 
as  was  required  in  [2]  ,  since  computing  the  inverse  of  a 
matrix  consumes  a  lot  of  computer  time.   The  smoothing 
filter  equations  used  are  derived  in  Appendix  B. 

After  each  DF  bearing,  THTD (K) ,  is  filtered  and  the 
first  DF  bearing,  THTDl(k),  is  smoothed  based  on  all  succes- 
sive bearing  estimates,  a  test  is  made  to  determine  if 
processing  should  be  switched  to  extended  Kalman  filtering, 
which  is  done  in  subroutine  EXTEND.   This  test  compares 
Pll(K)  with  the  product  of  EXTEST  and  RCUT,  where  EXTEST  is 
a  multiplier  to  vary  the  size  of  the  gate.   If  EXTEST  is 
set  equal  to  zero,  the  processing  will  always  stay  in  the 
angle  filter.   As  EXTEST  is  increased  the  processing  will 
switch  to  EXTEND  earlier  and  earlier  in  the  data  sequence 
but  the  initial  estimate  of  the  target  position  used  to 
initialize  the  extended  filter  will  be  worse,  as  will  the 
initial  value  of  the  P  matrix  in  the  extended  filter  equa- 
tions described  in  part  F  of  this  section. 

If  it  is  decided  that  all  of  the  DF  bearings  correlated 
to  a  target  will  be  angle  filtered,  GEORGE  calls  subroutine 
PREPARE  which  in  turn  calls  subroutine  POSIT  which  computes 
the  emitter  location  based  on  the  DF  bearings  THTDl  and 
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THTD  directly.   These  subroutines  are  discussed  later  in 
this  section. 

The  value  of  the  multipliers  of  both  tests  in  GEORGE, 
TSTCUT  and  EXTEST,  are  calling  arguments  for  the  subroutine 
so  they  can  be  controlled  by  the  main  program. 

All  of  the  Kalman  filter  initializations  for  GEORGE 
are  discussed  in  [2] .   The  fixed  delay  smoothing  equations 
are  initialized  with  the  initial  smoothed  estimate  THTDl(l), 
being  set  equal  to  the  initial  filtered  estimate  THTD(l). 
THTD(l)  was  set  equal  to  the  measured  value  of  the  first  DF 
bearing,  THETAD(KI). 

C.   SUBROUTINE  PREPARE 

When  vector  products  are  used,  the  order  of  multiplica- 
tion is  critical;  if  the  order  is  reversed,  the  resultant 
will  be  reversed.   In  the  problem  of  emitter  position 
locating,  a  reversed  resultant  will  produce  a  fix  on  the 
opposite  side  of  the  earth.   PREPARE  is  written  to  prevent 
this  occurrence.   First  the  direction  of  the  track  of  the 
aircraft  is  computed.   Then  THTD  and  THTDl  are  checked  to 
determine  on  which  side  of  the  track  they  lie  and  ensure 
that  they  both  lie  on  the  same  side  of  the  track.   If  they 
do  not,  no  position  fix  is  calculated.   If  they  do  lie  on 
the  same  side  of  the  track,  they  are  checked  to  see  if  they 
cross.   If  not,  no  fix  is  computed.   PREPARE  then  computes 
the  calling  arguments  for  POSIT  -  ACLAD,  ACLON,  and  THD. 
ACLAD  and  ACLON  are  the  latitude  and  longitude  coordinates 
respectively  of  the  aircraft  at  the  times  the  two  DF  bearings 
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were  recorded.   THD  contains  the  direction  of  the  two  bear- 
ings THTD1  and  THTD.   In  so  doing,  it  ensures  that  the  DF 
bearing  with  the  larger  angle  of  arrival  is  crossed  into 
the  bearing  with  the  smaller  angle  of  arrival  and  not  vice 
versa.   PREPARE  is  also  called  by  ELIPS6  and  EXTEND. 

D.   COMPUTING  INITIAL  POSITION  -  (SUBROUTINE  POSIT) 

POSIT  then  computes  the  desired  location  by  the  method 
described  in  Section  II,  part  D.   First  the  bearing  vectors, 
6_(1  n)  ,  and  6_(n|n),  are  expressed  in  the  earth  centered 
cartesian  coordinate  system.   Then  the  cross  product  of  the 
two  bearing  vectors  is  computed  giving  the  target  vector  in 
x,  y,  z  coordinates.   These  coordinates  are  converted  to 
latitude  and  longitude  coordinates  by 


TLAD   =    TAN-1( — ,    Xj?         ,.  —  [  (48 

VX1   +X2 


TLOD   =    TAN    -1      ~^f-  (49) 

where  XI,  X2 ,  and  X3  are  the  x,  y,  z  coordinates  respectively, 
An  example  illustrating  the  method  used  to  find  the  target 
vector  is  given  in  Appendix  C. 

E.   DEFINING  THE  ERROR  ELLIPSE  -  (SUBROUTINE  POINTS) 

If  it  is  decided  that  the  data  should  be  processed  by 
the  extended  Kalman  filter,  POINTS  is  first  called.   POINTS 
uses  POSIT  to  compute  the  intersections  of  the  edges  of  the 
cones  of  error  associated  with  THTD  and  THTDl.   These  points 
are  shown  in  Fig.  6.   POINTS  ensures  that  PTLAT (1, I , J) , 
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Semi-major 
axis 


Figure  6.    Target  Position  Error  Covariance  Ellipse, 
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PTLON (1 ,1 , J)  is  always  the  intersection  closest  to  the 
flight  track  and  it  determines  if  the  DF  bearings  THTDl  and 
THTD  do  in  fact  cross.   If  they  do  not,  it  makes  sure  that 
EXTEND  is  not  called  by  returning  to  the  calling  program  at 
a  point  after  the  EXTEND  call. 

F.   EXTENDED  KALMAN  FILTERING  -  (SUBROUTINE  EXTEND) 

In  linearizing  the  system  by  using  a  Taylor  series  expan- 
sion, it  was  assumed  that  the  M  matrix  would  be  fairly  con- 
stant over  the  range  of  uncertainty  of  x,  therefore  the 
initial  value  of  x,  x(0) ,  must  be  a  good  approximation  of 
the  true  value  of  x  or  the  filter  can  diverge.   To  find  an 
initial  estimate  of  the  true  value  of  x,  the  DF  bearings  are 
first  angle  filtered  in  subroutine  GEORGE.   When  the 
covariance  of  error  of  the  current  bearing  estimate,  Pll (K) , 
becomes  less  than  EXTEST  times  the  variance  of  the  measure- 
ment noise,  RCUT,  the  processing  is  switched  to  the  extended 
Kalman  filter  routine,  EXTEND. 

EXTEND  calls  PREPARE  for  an  initial  estimate  of  the 
target  position  coordinates,  TLAD,  and  TLOD.   EXTEND  then 
computes  the  semi-major  axis,  a,  and  the  semi-minor  axis,  c, 
of  the  error  covariance  ellipse  described  by  the  coordinates 
from  POINTS  and  centered  at  the  coordinates  computed  by 
PREPARE . 

The  length  of  the  semi-major  axis  of  the  error  ellipse 
was  assumed  to  be  the  distance  from  the  initial  target  loca- 
tion, TGT,  to  the  intersection  of  the  error  cones  closest 
to  the  flight  track.   These  points  are  shown  in  Fig.  6. 
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The  length  of  the  semi-minor  axis  is  found  in  the  following 
manner. 

The  distance  from  the  target  position,  TGT,  to  point  3 
and  the  distance  from  TGT  to  point  4  are  computed.   The 
projection  of  the  average  of  these  two  distances  on  to  a 
line  perpendicular  to  the  semi-major  axis  is  the  length  of 
the  semi-minor  axis. 

The  orientation  of  the  error  ellipse  on  the  surface  of 
the  earth  is  taken  to  be  the  amount  of  clockwise  rotation  of 
the  semi-major  axis  from  the  meridian  passing  through  the 
center  of  the  ellipse. 

A  and  c  uniquely  describe  an  ellipse  in  an  x'  y'  coor- 
dinate frame  according  to 

2      2 

*y  +  *2  =  *•  (50) 

c     a 

The  x'y'  system  is  rotated  by  an  angle  (90-ot)  degrees  from 
the  xy  system  in  which  the  extended  Kalman  filter  functions. 
The  x  and  y  axes  correspond  to  longitude  and  latitude 
respectively  on  a  flat  earth  model.   The  extended  filter  will 
find  an  optimal  estimate  of  the  coordinates  of  the  emitter 
position  in  the  xy  system.   To  describe  the  error  ellipse  in 
the  xy  system,  a  coordinate  system  rotation  was  made  accord- 
ing to  the  transformation  matrix. 


x 

y 


cosa   -sma 
sina   cosa 


y" 


(51) 
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After  performing  this  transformation  and  making  simplifying 
trigonometric  substitutirms  (see  Appendix  D)  the  initial 
values  for  the  covariance  matrix  P,  become 

Pll(KI)  =  (A  sina)2  +  (C  cosa) 2  (52) 

P12(KI)  =  (A2-C2)  sinacosa  (53) 

P22(KI)  =  (A  cosa)2  +  (C  sina)2  (54) 

Using  (31),  EXTEND  computes  an  initial  estimate  of  0, 
TX,  which  is  used  to  compute  the  initial  extended  filter 
error  term,  ER(KI)=THETA (KI) -TX(KI) ,  where  THETA  is  the 
measured  DF  bearing  angle  in  radians.   The  initial  gains 
associated  with  the  nonlinear  measurement  equation  are  found 
from  (37).   The  initial  estimate  of  longitude,  XTD,  is  set 
equal  to  TLOD,  and  YTD,  the  initial  value  of  latitude,  is 
set  equal  to  TLAD. 

The  initial  inputs  to  the  linear  longitude  and  latitude 
filter,  XTD1  and  YTDl,  are  then  found  by  substituting  (11) 
into  (10) ,  rewritten  as 

XTD1(KI)=XTD(KI)  +  GX (KI ) ER (KI)  (55) 

YTD1(KI)=YTD(KI)  +  GY  (KI)  ER  (KI)  .  (56) 

Then  the  outputs,  XTD  and  YTD,  of  the  linear  filters  are  fed 
into  the  linearized  filter  and  the  process  proceeds  as 
described  for  initialization. 

The  longitude  and  latitude  filter   equations  are  identi- 
cal to  the  corresponding  filters  in  subroutine  NAV  except 
for  notation,  as  listed  in  Appendix  A. 
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The  <J>  matrix  for  the  linearized  measurement  filter  is 
the  identity  matrix  since  the  states  of  this  filter  are 
longitude  and  latitude  only. 

On  each  recursion  of  the  filter  the  error  term  ER,  is 
compared  with  a  gate  identical  to  the  correlation  gate  in 
subroutine  GEORGE.   Any  DF  bearings  failing  the  test  are 
assigned  to  a  new  target  and  are  processed  either  in  the 
angle  filter  or  in  EXTEND  on  a  later  call  of  the  subroutine, 
The  extended  Kalman  filter  equations  are  derived  in  Appen- 
dix D. 
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IV.   PRESENTATION  OF  RESULTS 

The  Monte  Carlo  simulation  developed  in  [2]  was  utilized 
to  accomplish  program  validity  and  error  analysis  studies. 
The  scenario  developed  for  that  simulation  was  of  an  aircraft 
flying  south  along  the  118°W  meridian  at  a  ground  speed  of 
600  knots  and  with  heading  of  180°.   Bearing  angles-of- 
arrival  were  recorded  from  two  VORTAC  stations  located  at 

Emitter  1  Oceanside  VORTAC  33.24055°N 

117.41694°W 

Emitter  2  San  Diego  VORTAC  32. 78222 °N 

117.22444°W 

DF  cuts  and  aircraft  position  fixes  were  recorded  every  six 
seconds  alternately  from  each  target  giving  a  uniform 
sampling  interval.  Known  true  bearing  angles  were  computed 
numerically  from  the  aircraft  position  coordinates  and  the 
emitter  position  coordinates  to  obtain  a  very  accurate  data 
base.  The  DF  cuts  obtained  are  shown  in  Fig.  7  for  emitter 
1  and  in  Fig.  8  for  emitter  2. 

Normally  distributed,  zero  mean  random  noise  with  an 
assumed  variance  of  1  was  added  independently  to  the  lati- 
tude fixes,  longitude  fixes,  and  angles-of -arrival.   The 
errors  in  aircraft  heading  and  angle-of-arrival  were  combined 
into  the  single  angle-of-arrival  error.   The  flight  track 
and  noisy  DF  bearings  are  shown  in  Figs.  9  and  10  for  emit- 
ters 1  and  2  respectively. 
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Figure  7.   Lines-of-Bearing  on  Emitter  1 
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Figure  9.   Noisy  Lines-of-Bearing  on  Emitter  1, 
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PLOT    OF   DF   CUTS   FIND   R/C  NRUlfeRTlON   ORTR 


Figure  10.  Noisy  Lines-of-Bearing  on  Emitter  2 
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A.   ERROR  ANALYSES 

A  large  number  of  simulation  runs  were  executed  to 
obtain  a  statistically  valid  error  analysis,  where  each 
run  constituted  a  complete  mission.   The  results  of  these 
analyses  are  given  in  Appendix  E  and  are  summarized  below 
for  the  two  simulation  emitters. 

The  results  of  the  error  analysis  of  the  navigation  data 
filter  are  listed  on  page    .   The  average  of  the  noise 
added  to  the  positions  is  shown  as  is  the  mean-square  value 
of  that  noise.   By  comparing  the  listed  mean-square  error 
of  the  positions  with  that  of  the  noise,  it  can  be  seen  that 
the  model  utilized  in  the  program  has  a  bias  which  develops 
after  a  large  number  of  runs.   Each  run  is  a  complete  flight 
of  61  position  fixes,  so  the  result  after  45  runs  is  the 
statistical  average  of  2745  data  points.   The  results  of  2, 
10,  45,  and  50  runs  was  found  to  be 


LATITUDE 

LONGITUDE 

Runs 

Mean-Square   Me 

an-Square 

Mean-Square 

Me 

an-Square 

Noise 

Error 

Noise 

Error 

2 

.427 

.326 

1.80 

1.21 

10 

.937 

1.02 

1.24 

1.16 

45 

1.26 

1.37 

1.19 

1.24 

50 

1.19 

1.31 

1.14 

1.23 

—  8 
The  units  for  this  list  are  degrees  times  10   .   The  error 

associated  with  each  individual  position  fix  on  a  single  run 

is  shown  on  page 
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For  the  analysis  of  the  angle  filter,  a  range  error  was 
computed  from  each  estimated  emitter  position  latitude  error 
and  longitude  error,  and  all  errors  were  statistically 
averaged  for  the  total  number  of  runs . 

The  longitude  error  which  is  perpendicular  to  the  flight 
path  was  found  to  be  much  larger  than  the  latitude  error. 
This  result  agrees  with  the  theory  used  to  develop  the 
ellipses  which  describe  the  initial  covariance  matrix  for 
the  extended  Kalman  filter.   This  result  also  agrees  with 
the  final  orientation  of  the  target  error  ellipses  as  shown 
on  page  51  and  52.   The  results  of  this  analysis  are  sum- 
marized below  for  50  runs. 


AVERAGE 

AVERAGE 

AVERAGE 

LATITUDE 

LONGITUDE 

RANGE 

ERROR 

ERROR 

ERROR 

EMITTER  1 

.684 

1.129 

1.391 

EMITTER  2 

.685 

1.870 

2.098 

The  units  of  the  above  table  are  nautical  miles. 

The  results  of  the  error  analysis  of  the  extended  Kalman 
filter  are  shown  on  page  73.   The  errors  of  each  individual 
flight  which  are  listed  on  that  page  point  out  the  dependency 
of  this  filter  on  the  accuracy  of  the  initial  estimate  of  the 
emitter  position.   Since  the  initial  estimate  is  based  on 
only  four  DF  bearings  for  this  simulation,  this  estimate  is 
heavily  weighted  by  the  noise  added  to  the  first  bearings  and 
the  rate  of  convergence  of  the  filter.   The  results  of  the 
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analysis  of  the  extended  filter  are  given  below  for  50  runs 
with  the  units  being  nautical  miles. 


AVERAGE 

AVERAGE 

AVERAGE 

LATITUDE 

LONGITUDE 

RANGE 

ERROR 

ERROR 

ERROR 

EMITTER  1 

1.535 

4.654 

4.988 

EMITTER  2 

.872 

7.784 

7.876 

B.   COMPUTER  PROCESSING  OF  SIMULATED  DATA 

A  series  of  plots  showing  the  ability  of  this  program  to 
locate  target  positions  in  the  absence  of  noise  starts  on 
page  50.   The  number  in  the  lower  right  corner  is  the  number 
of  the  DF  bearing  estimate  associated  with  that  target  which 
was  used  to  compute  the  target  position  and  error  ellipse  in 
that  plot.   The  plots  on  page  51,  52  and     show  the  four 
points  of  intersection  computed  by  POINTS  which  describe 
the  error  ellipse.   From  these  plots,  it  can  be  seen  that 
the  error  ellipse  does  accurately  describe  the  area  of  the 
probability  region  associated  with  each  position  fix. 

The  output  of  a  single  run  of  the  program  using  the 
simulated  data  starts  on  page  76.   The  first  run  assumes 
that  processing  will  be  strictly  by  the  angle  filter.   The 
output  of  a  run  in  which  the  extended  filter  was  utilized 
starts  on  page  110.   Plots  of  the  error  ellipses  associated 
with  the  covariance  matrices  of  each  filter  are  included  in 
the  output. 

These  series  of  plots  show  the  change  of  orientation  of 
the  error  ellipse  as  the  aircraft  progressed  along  its  flight 
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path.   They  also  illustrate  the  decrease  in  area  of  the 
ellipses  as  more  data  is  collected  and  as  the  angle  between 
the  smoothed  initial  bearing  0 (1/N) ,  and  the  filtered  final 
bearing  6  (N/N)  increased. 

By  comparing  the  plots  of  the  ellipse  associated  with 
the  angle  filter  on  page  50  and  the  plot  on  page  53  associa- 
ted with  the  extended  filter,  it  can  be  seen  that  the 
extended  filter  is  initialized  with  the  same  error  covari- 
ance  as  the  angle  filter. 

Further  comparison  of  the  two  series  of  plots  shows  that 
the  position  of  the  centers  of  the  ellipses  produced  by  the 
angle  filter  are  much  more  erratic  than  those  of  the  extended 
filter.   This  indicates  that  the  angle  filter  has  a  faster 
response  to  each  new  bit  of  data  than  the  extended  filter. 
The  response  may  seem  too  fast,  but  in  order  to  have  a  rapid 
rate  of  convergence  of  the  filter  so  processing  could  switch 
quickly  to  the  extended  filter,  fast  response  is  necessary, 
so  this  is  a  compromise. 

The  slow  response  of  the  extended  filter  is  shown  by 
the  relatively  slow  rate  of  rotation  of  the  error  ellipse. 
The  slow  response  is  desirable  to  prevent  the  filter  from 
converging  too  rapidly  onto  a  wrong  point  if  it  is  initial- 
ized with  a  poor  initial  position  fix. 

C.   AIRCRAFT  FLIGHT  DATA  PROCESSING 

The  output  of  a  computer  run  using  data  from  an  actual 
flight  starts  on  page  144.   The  effectiveness  of  the  data 
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sort  routine  is  shown  by  the  lists  on  page  146  and  147.   The 
first  list  is  the  result  of  the  sort  on  PRF  and  FREQUENCY 
only.   The  second  list  is  the  final  correlation  after  the 
data  has  been  correlated  to  targets  using  the  test  discussed 
on  page  31. 
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PLOT  GF  ERROR  COURRIRNCES  OF  SMOOTHED  BERRING  LINES 
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PLOT  OF  ERROR  C0URR1RHCE5  OF  SMOOTHED  BERR1HG  LINES 
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PLOT  OF  ERROR  C0URRIRNCE5  OF  EXTENDED  KRLMRNFILTER 
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PLOT  OF  ERROR  CQURRJRNCES  OF  EXTENDED  KRLMRN  FILTER 


33,75 


33'.  50  33.25  33*00 

DEGREES   LRTITUDE 


32.75 


CO 


54 


PLOT    IT    ERROR    CDURRJRNCES   OF   EXTENDED   KRLMRNFILTER 
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Figure   llf 
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PLOT  3F  ERROR  GOURRIRNCES  OF  EXTENDED  KRLMRN  FILTER 
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CONCLUSIONS 


i 


The  fact  that  Kalman  filtering  of  digital  data  works  is 
nothing  new,  many  examples  can  be  found  in  the  literature. 
This  report  has  shown  a  particular  application  of  the  Kalman 
theory  and  presented  a  program  which  will  work  in  that 
application,  i.e.  the  processing  of  airborne  DF  information. 

There  are  several  areas  of  this  study  which  need  more 
research  and  testing.   A  more  complete  model  for  the  navi- 
gation filter  could  be  developed  which  would  reduce  the  bias 

present  in  the  one  utilized  for  this  report.   Then  it  should 

i 
be  determined  if  the  bias  is  harmful  or  not  and  if  it  is 

worth  the  resulting  increases  in  computer  processing  to 

remove  the  small  error.   The  response  of  the  two  emitter 

position  locating  filters  should  be  looked  at  to  determine 

if  there  is  a  more  optimal  Q  for  both;  schemes. 

A  program  for  plotting  the  error  ellipses  of  each  target 

for  each  filtering  scheme  was  presented.   This  program 

[ 

provides  a  capability  for  displaying  graphically  the  effect 

I 
i 

of  varying  the  different  parameters  which  are  inputs  to  the 

E 

subroutines,  plus  the  effect  of  varying  filter  response  time, 

Many  current  elint  systems  have  a  digital  computer  as  a 

I 

link  in  their  processing  chain,  but  it  is  used  strictly  as 

a  device  to  plot  the  data  and  no  attempt  is  made  to  compute 
an  optimal  emitter  location  solution.   By  implementing  this 
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Kalman  filter  program,  the  effectiveness  of  the  elint  system 
could  be  greatly  enhanced  by  reducing  manual  processing  time 
and  produce  more  accurate  target  position  coordinates. 
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APPENDIX  A 
DERIVATION  OF  SCALAR  KALMAN  FILTER  RECURSION  EQUATIONS 


The  Kalman  filter  equations  for  all  of  the  linear  models 
in  this  program  can  be  derived  in  the  same  general  form 
described  below.   The  variable  names  used  in  each  individual 
subroutine  to  represent  the  general  terms  in  the  derivation 
are  listed  at  the  end  of  this  section. 

The  Kalman  filter  recursion  equations  from  page  10,  (7) 
through  (11) ,  are  listed  below: 


P(k|k-1)  =  <}>(k,k-l)P(k-l|k-l)<j>(k,k-l)T  +  Q  00 


G(k)  =  P(k|k-l)H(k)T[H(k)P(k|k-l)H(k)T  +  R(k)] 


P(k|k)  =  P(k|k-1)  -  G(k)H(k)P(k|k-l) 


X(k|k)  =  X(k|k-1)  +  G(k)  [Z  (k)  -  H  (k)  X  (k  |  k-1)  ] 


X(k|k-1)  =  <Mk,k-l)X(k-l|k-l) 


,-1 


(1A) 


(2A) 


(3A) 


(4A) 


(5A) 


where  in  this  application  cj>(k+l,k)  = 
H(k)  =  [1   0]  , 


1   T(k+1) 
0     1 


the  P  and  Q  matrices  may  be  considered  to  have  scalar  com- 
ponents given  by 


Pll    P12 
P21    P22 


and 


Qll    Q12 
Q21    Q22 


respectively, 


and  the  G  matrix  is  a  2x1  matrix  of  the  form 


Gl 
G2 
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Writing  (2A)  in  matrix  notation  yields 


Gl 

Pll 

P12 

1 

G2 

P21 

P22 

0 

[l  °] 


Pll   P12 
P21   P22 


r 

+    R 

0 

-1 


(6A) 


and  for  the  observation  matrix  H (k)  =  [1   0],  the  inverse 
term  becomes  a  scalar  allowing  the  gain  terms  to  be  computed 
directly  as  is  shown  below: 


Gl 
G2 


Pll 
P21 


[pii  +  r] 


-1 


(7A) 


which  results  in  the  scalar  gain  equations 


Gl(k)  = 


G2(k)  = 


Pll(klk-l) 


Pll(k|k-1)  +  R(k) 

P21(k|k-1) 
Pll(kjk-l)  +  R(k) 


(8A) 


(9A) 


let  the  P  matrix  be  defined  by 

P(k/k-l)  =E  J0(k)  -  6(k|k-l)l  [©(k)  -  9(k|k-l)J      (10A) 

from  which  it  can  be  seen  that  since  6  and  6  are  statisti- 
cally independent ,' where 

0=0-6/ 

then  P12  =  P21,  and  the  P  matrix  is  symetric.   From  (15)  it 
can  be  seen  that  the  Q  matrix  is  also  symetric.   Equation 
(9A)  then  becomes 


G2(k)  = 


P12(k|k-1) 


Pll(klk-l)  +  R(k) 


(HA) 


To  solve  for  the  prediction  covariance  terms,  (3A)  was 
substituted  into  (1A)  giving 
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~P11   PI  2 
P12   P22_ 

= 

1 
0 

T 
1 

[~P11   P12 
P12   P22 

- 

"gi" 

G2 

b 

°] 

Pll  Pl2~ 

P12   P22 

1  cf 

T   1_ 

+ 

Qll   Q12" 
Q12   Q22 

k-l|j 

k|k-l 

k|k-l 

. 

(12A) 

VARIABLE  NAMES  USED  IN  PROGRAM  TO  REPRESENT 
VARIABLES  IN  GENERAL  DERIVATION 


General 

Variable 

R 

P 

P 

G 

X 

X 

X 

E 

Z 

Subroutine 

Name 

NAV 

RNAV 

SP 

SPKK 

SG 

LATITUDE 

SLAD 

VELED 

SLATD 

ELAT 

ACLAD 

LONGITUDE 

SLOD 

VELND 

SLOND 

ELON 

ACLOD 

GEORGE 

RCUT 

P 

- 

G 

THTD 

TDTD 

TPTD 

E 

THETAD 

EXTEND 

EXTEND 

EP 

— 

G 

LATITUDE 

XTD 

XTDDOT 

XTDHAT 

EX 

XTD1 

LONGITUDE 

YTD 

YTDDOT 

YTDHAT 

EY 

YTD1 

LINEARIZED 

MEASURE- 

P 

- 

XTD1 

- 

TX 

ER 

THETA 

MENT 

YTDL 

- 

TX 

ER 

THETA 
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APPENDIX  B 
DERIVATION  OF  SMOOTHING  FILTER  EQUATIONS 

A.   FIXED  POINT  SMOOTHING 

The  equations  used  to  smooth  the  estimates  of  the  first 
DF  bearing,  THTDl,  for  a  given  target  are  listed  on  page  15 
and  are  repeated  below  with  k  =  1. 

1.  Filter  Equation 

X(l|j)  =  X(l|j-1)  +  W(j)H(j)TR_1(j)  [Z(j) 

-  H(j)<MJ,j-DX(j-l|  j-1)]  (IB) 

where  j  =  2,3,...,  and  the  initial  condition  is  X(lll). 

2 .  Gain  Equation 

W(j)  =  W(j-l)4>(j,j-l)T[l-S(j)P(j|  j)]  (2B) 

where  W(l)  =  P(l|l)  and  S(j)  =  H  ( j)  TR~1  ( j)  H  ( j  ) 

3.  Covariance  Equation 

P(l|j)  =  P.(l|j-1)  -  W(j)  [s(j)P(j|  j-l)S(j) 

+S(j)]  W(j)T  (3B) 

where  the  initial  condition  is  P(l|l).   P(jlj)  and  P(j|j-1) 
are  the  error  covariance  matrices  from  the  optimal  filter 
and  predictor  respectively.   Since  H  =  [1   0]  and  R(j)  is  a 
scalar,  these  matrix  equations  become  scalar  expressions. 

To  compute  a  smoothed  estimate  of  X(l|j),  it  is  first 
necessary  to  solve  (2B)  for  the  values  of  the  gains  to  be 
used  in  (IB) . 
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First  solve  for  S(j) 


S(j)  - 


Then  noting  that 


k[}  °]  - 


1/R      0 
0         0 


(4B) 


<MJ,j-D    = 


1         0 
T(j)    1 


(5B) 


Equation    (2B)    becomes 


Wll      W12 

Wll      W12n 

i 

0~| 

i 

[~1 

0 

1/R 

0~ 

"Pll      P12"| 

W21      W22 

W21      W22_ 

T 

1 

L° 

1 

0 

0_ 

P12      P22 

—                                         -J 

d/j 

) 

(i/j-i: 

(j/j) 

(6B) 


To  solve  (IB)  first  note  that 


Z(j)  =  H(j)<J.X(j-l|  j-1)  =  [l   o] 


1   T 
0   1 


X- 


X^ 


=  X. 


X2T   (7B) 


so  therefore  let  E  ( j)=Z(j)-X,  (j)  -X  ( j)T  (j)  .   Then  in  the 
notation  used  in  the  program 


THTD1~ 

THTD1 

+ 

TDTDl 
d/jl 

THTD1 
(1/j-D 

Wll   W12 
W21   W22 


E(j) 

R 


(8B) 


The  error  covariance  matrix  for  the  fixed  point  smoothing 
filter  is 


D  = 


Dll   D12 
D21   D22 


(9B) 


so  (3B)  written  matrix  form  is 


63 


Dll   D12 

D21   D22 
d|j) 


Dll   D12 

D21   D2  2_ 
(l|j-D 


Wll   W12 
W2i   W22 


1/R 

0 

+ 

0 

0_ 

1/R  0 

0  0_ 

1/R  0" 

0  0 


Pll   P12 
P12   P22 

Wll   W21 
W12   W22 


(10B) 


B.   FIXED  INTERVAL  SMOOTHING 

The  fixed  interval  smoothing  equations  are  listed  on 
page     and  are  repeated  below. 

1.  Filter  Equation 

X(k|n)  =  X(k|k)  +  A(k)  [x(k+l|n)  -  X(k+l|k)]      (11B) 

for  k  =  n-l,n-2 , . . . , 0 ,  where  X(njn)  is  the  boundary  condi- 
tion for  k  =  n-1. 

2 .  Gain  Equation 

A(k)  =  P(k|k)4>  (k+l,k)TP-1(k+l|k)  (12B) 

3.  Covariance  Equation 

P(k|n)  =  P(k|k)+A(k)  [p  (k+1 1  n)  -  P  (k+1  |"k)l  A  (k)T   (13B) 

The  covariance  equation  is  not  used  in  the  computation  of 
the  smoothed  estimate  of  X(k|n)  or  filter  gain  A(k),  so  it 
was  not  utilized  in  the  program. 

First  the  values  of  the  gain  matrix  A,  are  computed. 
Using  the  notation  PIN=P    (12B)  becomes 


All   A12 


A21   A22 


Pll   P12 
P12   P22 


1   0 
T   1 


(14B) 


PIN 11   PIN 12 
PIN12   PIN22 

where  P(k|k)  and  P  (k+1 Ik)  are  the  covariance  terms  from  the 
optimal  filter  equations  and  the  fact  that  P12=P21  is 
utilized. 
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Again  letting  E  (k)  =  X(k+l|n)  -  H  (k)  <J>  (k+1 1  k)  X  (k  |  k)  , 
(11B)  becomes 

X(k|n)  =  X(k|k)  +  A(k)E(k)  (15B) 

and  (11B)  is  written  in  the  notation  used  in  the  program  as 


and 


SLAPSM 

SLAD 

= 

+ 

VELNDSM 

VELND^ 

All   A12 
A21   A22 


[eladi] 


(16B) 


SLODSM 



SLOD 

+ 

VELEDS^ 

_VELED_ 

All   A12 
A21   A22 


[eloniI 


(17B) 


65 


APPENDIX  C 

DERIVATION  OF  THE  VECTOR  METHOD 
POSITION  LOCATING  ALGORITHM 

This  algorithm  is  divided  into  three  basic  sections; 
(A)  computation  of  normal  vectors  to  the  bearing  plane,  (B) 
computation  of  bearing  vectors,  and  (C)  computation  of  the 
target  position  vector. 

A.  COMPUTATION  OF  THE  NORMAL  VECTOR  TO  THE  BEARING  PLANE 
The  normal  vector  of  the  bearing  planes  are  computed  as 

described  in  Section  II, D,  using  the  aircraft  latitude  and 
longitude  (<jj,0),  and  the  DF  bearing  angle  a. 

The  bearing  plane  has  the  equation  dxx  +  dyy  +  dzz  =  0. 
The  normal  vector,  N,  can  be  written  in  the  form 

N  =  dxi  +  dyj  +  dzk  (1C) 

where  i,j,k  are  the  unit  base  vectors  in  the  x,y,z 
directions.   The  components  dx,  dy,  and  dz,  of  normal  vector 
N  correspond  to  the  coefficients  found  from  (27) .   That  is 

dx  =  -sin  a  sin0  -  cos  a  cos  0  sin  cj>  (2C) 

dy  =  sin  a  cos  0  -  cos  a  sin  0  sin<}>  (3C) 

dz  =  cos  a  cos  cj)  (4C) 

B.  COMPUTATION  OF  BEARING  VECTOR 

Let  SI(x,y,z)  =  xl  +  yj  +  zk  denote  the  aircraft  position 
vector.   The  cross  product  of  SI  and  N  produce  the  vector 
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perpendicular  to  the  plane  of  both  SI  and  N  which  is  the 
bearing  vector  D(I),  thus 


D(I)  -  SI  X  N  = 


1     j     k 

x     y     z 
dx    dy    dz 


so  that  D(I)  =  A(I)i  +  B(I)j  +  C(I)k,  1=1,2,  where 

A=yxDZ-zxDY 
B=zxDX-xxDZ 
C   =    xxDY-yxDX. 


(5C) 


(6C) 
(7C) 
(8C) 


Then  each  of  the  vectors  is  normalized  to  determine  the 
length  of  the  unit  vector  by  dividing  by  D  where 


D  =  yjh2    +    B2  +  C2  . 


(9C) 


C.   COMPUTATION  OF  THE  TARGET  POSITION  VECTOR 

The  two  bearing  vectors  D(l)  and  D(2)  are  cross  multi- 
plied to  find  the  x,y,z  coordinates  of  the  target  vector. 
So 


X  =  D(l)  x  D(2) 


x    y     z 
Al    Bl    CI 
A2    B2    C2 


(IOC) 


The  algorithm  for  finding  the  target  position  vector  is 
therefore 


XI  =  Bl  x  C2  -  B2  x  CI 
X2  =  A2  x  CI  -  Al  x  C2 
X3  =  Al  x  B2  -  A2  x  Bl  . 


(11C) 
(12C) 
(13C) 
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This  vector  is  normalized  to  a  unit  vector  with  one  unit 
being  the  radius  of  the  earth. 

To  find  the  latitude  and  longitude  coordinates  of  the 
target  position  the  following  equations  are  used 


TLAD  =  tan-1        X3      I  CM  ) 


2      2 
XI   +  X2 


TLOD  =  tan     ~  (15  ) 


D.   EXAMPLE  OF  VECTOR  METHOD  FOR  LOCATING  TARGET  POSITION 

A  DF  bearing  of  30  degrees  is  taken  when  the  aircraft  is 
at  latitude  30  degrees  north  and  longitude  45  degrees  east. 
A  second  DF  bearing  of  60  degrees  is  taken  from  the  same 
emitter  when  the  aircraft  is  at  31  degrees  north  and  45 
east. 

1.  First  find  the  normal  vector  to  the  bearing  plane  by 
substituting  the  values  of  <j>,  6,  and  a  into  (2C)  through 

(4C). 

DX  =  -sin30  sin45  -  cos30  cos45  sin30  =  -.6597 
DY  =  sin30  cos45  -  cos30  sin45  sin30  =  .0473 
DZ  =  cos30  cos30  =  .750 

2.  Using  (21)  through  (23)  find  the  x,y,  and  z  com- 
ponents of  the  aircraft  position  vector. 

x  =  cos30  cos45  =  .6123 
y  =  cos30  sin45  =  .6123 
z  =  sin30  =  .500 
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3.  Next  find  the  bearing  vector,  D(I),  which  is  the 
cross  product  of  the  aircraft  position  vector  and  the  normal 
to  the  bearing  plane,  using  (6C)  through  (8C). 

Al  =  .6123  x  .750  -  .50  x  .0473  =  .4356 

Bl  =  .50  x  (-.6597)  -  .6123  x  .750  =  -.7872 

CI  =  .6123  x  .0473  -  .6123  x  (-.6597)  -  .4329 

4.  Find  the  value  of  D  that  will  normalize  D(I)  to  a 
unit  vector.   Using  (9C) 


1897  +  .6228  +  .187  =  1.0 


Therefore,  the  bearing  vector  is  already  a  unit  vector. 

5.  Similarly  the  corresponding  values  for  the  second 
bearing  are:   DX  =  .7944,  DY  =  .4302,  DZ  =  .42855,  x  =  .6061, 
y  =  .6061,  and  z  =  .5150. 

6.  Since  the  angle  of  arrival  of  the  second  DF  bearing 
is  larger  than  the  angle  of  the  first  bearing,  the  second 
bearing  must  be  crossed  into  the  first  to  obtain  the  outward 
pointing  position  vector.   Therefore  from  (9C)  and  (11C) 
through  (13C) 

XI  =  (-.6688)  x  .4329  -  (-.7892)  x  .7422  =  .2962 

X2  =  .4356  x  .7422  -  .0381  x  .4329  =  .3068 

X3  =  .0381  x  (-.7892)  -  .4356  x  (-.6031)  =  .2613 


D  =  J. 0877  +  .0941  +  .0682  =  .50 


^  - 

7.   Find  the  longitude  and  latitude  coordinates  of  the 
target  position  using  (14C)  and  (15C) . 


69 


TLOD  =  ARCTAN (.6136/. 5924)  =46.0  degrees 
TLAD  =  ARCTAN (.52  2  4/. 8529)  =  31.5  degrees 

The  computer  solution  to  this  problem  was  TLOD  =  46.01540 
and  TLAD  =  31.49590. 
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APPENDIX  D 
DERIVATION  OF  EXTENDED  KALI-IAN  FILTER  EQUATIONS 

A.   ERROR  COVARIANCE  EQUATION  INITIALIZATION 

The  ellipse  described  by  the  Pll  and  Dll  terms  in  the 
angle  filtering  routine  lies  in  the  X'Y'  coordinate  system 
which  is  rotated  counter-clockwise  (9  0  -  a)  degrees  from  the 
XY  coordinate  system  used  in  the  Extended  Kalman  Filter.   To 
determine  the  values  of  the  axes  of  the  ellipse  in  the  XY 
coordinate  system,  the  transformation  T,  described  by  (51) 
was  utilized. 


T  = 


cosa   -sina 
sina    cosa 


(ID) 


Let  the  semi-major  axis  be  A1  =  E[X'  -  X1],  and  the  semi- 

major  axis  be  C  =  E[Y'  -  Y1].   Define  Z  =  TX  where 

T 
X  =  [A1   C']/  then  the  error  covariance  matrix  P,  in  the  XY 

frame  is 


P  =  e[z  ZTJ  =  t  e[x  xt1tt. 
Writing  this  equation  in  matrix  form  yields 


(2D) 


Pll   P12 
P12   P21 


cosa   -sina 


sina    cosa 


A' 
C 


[a1  C'] 


cosa   sina 


-sina   cosa 


(3D) 


Carrying  out  the  indicated  matrix  multiplications  in  (3D) 
produces  (52)  through  (54)  which  are  repeated  here. 

Pll(KI)  =  (A  sina)2  +  (C  cosa)2  (4D) 


71 


P12(KI)  =  sina  cosa  (A2  -  C2)  (5D) 

P22(KI)  =  (A  cosa)2  +  (C  sina)2  (6D) 


B.  LATITUDE  AND  LONGITUDE  FILTER  EQUATIONS 

The  block  diagram  for  the  filter  system  used  in  subrou- 
tine Extend  is  shown  in  Fig.  1.   As  stated  in  Section  III, 
part  F,  the  latitude  and  longitude  filters  are  identical  to 
the  corresponding  filters  used  in  Subroutine  Nav  to  compute 
the  optimal  aircraft  position  estimates.   The  recursion 
equations  for  these  filters  are  derived  in  Appendix  A  with 
the  variable  names  utilized  in  this  subroutine  being  listed 
at  the  end  of  Appendix  A. 

C.  LINEARIZED  MEASUREMENT  EQUATIONS 

The  extended  Kalman  filter  recursion  equations  (36) 

through  (40)  are  similar  in  form  to  the  basic  Kalman  filter 

recursion  equations  on  page    ,  except  that  the  observation 

matrix  is  a  nonlinear  transformation  matrix  M  as  defined  by 

(35)  where 


M(k)  =  ?A 

9X 


X 


39    39 


3*T   3LT 


[~DMX   DMy]  (7D) 


Taking  partial  derivatives  of  (31)  yields 

an  (LT-L)    cos   L 

DMX   =   4f-  =    =-i T        (8D) 

dAT  (LT-L)2    +     UT-Ar    cos^LT 

ao           -U    -A)  [~(L   -L)    sinL      +    cosL   1 
DMY   =    |f-  =    5 L_T T TJ  (9D) 

dijT  (LT-L)^    +     (XT-Xr    cos^LT 
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These  terms  are  computed  numerically  and  substituted  into 
equations  (36)  and  (37)  which  are  rewritten  in  matrix  form 


as 

GX~ 
GY 

and 


Pll   P12 
P12   P22 


DMX 
DMY 


Tdmx  dmyJ 


Pll   P12 
P12   P22 


DMX 
DMY 


+  R 


-1 


(10D) 


Pll   P12 

P12   P22 
k+l|k 


1   0 
0   1 


Pll 

P12 

1 

0~ 

+ 

P12 

P22 

0 

1 

Qll   Q12 
Q12   Q22 


(11D) 


k|k 


Equation  (3  8)  is  then  substituted  into  (10D) ;  however,  the 
fact  that  the  cf>  matrix  is  the  identity  matrix  considerably 
simplifies  the  recursion  equations  since  they  are  no  longer 
dependent  on  the  sampling  interval  T(k).   Since  the  gain 
terms  are  computed  as  a  function  of  the  nonlinear  terms  DMX 
and  DMY,  it  is  essential  to  have  the  correct  units  for  the 
error  term  ER(k).   In  this  case  the  units  of  gain  are  not 
dimensionless  but  degrees  per  radian,  so  the  error  term 
must  be  given  in  radians  to  update  the  target  position 
estimates  in  degrees  of  latitude  and  longitude. 

Equation  (40)  is  substituted  into  (39)  and  written  in 
the  notation  used  in  the  program  is 


and 


XTDl(k)  =  XTD(k)  +  GX(k)ER(k) 


YTDl(k)  =  YTD(k)  +  GY(k)ER(k). 


(12D) 


(13D) 
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APPENDIX  E 
MONTE  CARLO  SIMULATION  ERROR  ANALYSIS 

ESTIMATED  AIRCRAFT  POSITION  ERROR  IN  DEGREES  LATITUDE 
LATITUDE  LONGITUDE 


RUN 

NOISE    ADDED 

SMOOTHED 

NOISE    ADDED 

SMOOTHED 

a 

TO    POSITION 

POSITION 
ERROR 

TO    POSITION 

POSITION 
ERROR 

1 

-0.921E-04 

-0.708E-04 

0.143E-03 

0.117E-03 

2 

0.775E-05 

0.388E-04 

0.125E-03 

0.103E-03 

3 

0.748E-04 

0.958E-04 

-0.378E-04 

-0.610E-04 

4 

-0.403E-04 

-0.200E-04 

0.236E-03 

0.213E-03 

5 

0.883E-04 

0.114E-03 

-0.152E-03 

-0.182E-03 

6 

-0.785E-04 

-0.548E-04 

0.158E-04 

-0.125E-04 

7 

0.348E-04 

0.578E-04 

-0.670E-04 

-0.918E-04 

8 

0.196E-03 

0.226E-03 

0.255E-04 

-0.775E-05 

9 

-0.723E-04 

-0.5C3E-04 

-0.153E-04 

-0.333E-04 

10 

-0.138E-03 

-0 .115E-03 

0.405E-04 

0.775E-05 

11 

-0.119E-03 

-0.886E-04 

0.225E-03 

0.199E-03 

12 

-0.580E-04 

-0.325E-04 

0.725E-04 

0.483E-04 

13 

0.643E-04 

0.873E-04 

0.485E-04 

0.901E-05 

14 

0.758E-04 

0. 1C8E-03 

0.625E-04 

0.383E-04 

15 

0.104E-03 

0.128E-03 

0.455E-04 

0.130E-04 

16 

-0.172E-03 

-0.146E-03 

-0.998E-04 

-0.131E-03 

17 

-0.948E-04 

-0.718E-04 

-0.833E-04 

-0.105E-03 

18 

0.158 E-03 

0.180E-03 

-0.132E-03 

-0.152E-03 

19 

0.543E-04 

0.765E-04 

-0.713E-04 

-0.923E-04 

20 

0.926E-04 

0.122E-03 

0.124E-03 

0.873E-04 

21 

-0.758E-04 

-0.505E-04 

0.295E-04 

0.926E-05 

22 

-0.888E-04 

-0.7C3E-04 

0.113E-03 

0.926E-04 

23 

-0.588E-04 

-0.368E-04 

0.107E-03 

0.840E-04 

24 

0.184E-03 

0.207E-03 

0.338E-04 

0.750E-05 

25 

-0.163E-03 

-0.142E-03 

0.263E-04 

0.875E-05 

26 

0.393E-04 

0.553E-04 

0.140E-04 

-0.625E-05 

27 

-0.199E-03 

-0. 175E-03 

0.132E-03 

0.110E-03 

28 

0.264F-03 

0.289E-03 

-0.108E-03 

-0.133E-03 

29 

0.166E-03 

0.190E-03 

0.620E-04 

0.368E-04 

30 

-0.208E-03 

-0.179E-03 

0.238E-04 

-0.700E-05 

31 

0.685E-04 

0.926E-04 

-0.650E-05 

-0.320E-04 

32 

-0.133E-03 

-0.111E-03 

-0. 1535-03 

-0.178E-03 

33 

-0.100E-05 

0.243E-04 

0.535E-04 

0.295E-04 

34 

-0.258E-04 

-0.125E-05 

-0.475E-04 

-0.670E-04 

35 

0.575E-05 

0.385E-04 

0.112E-03 

0.833E-04 

36 

0.112E-03 

•   0.135E-03 

-0.192E-03 

-0.229E-03 

37 

-0.658E-04 

-0.375E-04 

-0.150E-03 

-0.173E-03 

38 

0.315E-04 

0.545E-04 

-0.170E-03 

-0.201E-03 

39 

0.245E-04 

0.383E-04 

-0.465E-04 

-0.728E-04 

40 

0.285E-04 

0.448E-04 

0.114E-03 

0.916E-04 

41 

0.475E-04 

0.713E-04 

-0.242E-03 

-0.270E-03 

42 

-0.588E-04 

-0.300E-04 

0.490E-04 

0.253E-04 

43 

0.145E-03 

0.  174E-03 

-0.307E-11 

-0.288E-04 

44 

0.162E-03 

0.  189E-03 

-0.120E-03 

-0.144E-03 

45 

0.795E-04 

0.1 06 E-03 
AVERAGE 

0.107E-03 
ERRORS 

0.745E-04 

NOISE 

MEAN    SQUARE 
NOISE 

ERROR 

MEAN    SQUARE 
ERROR 

ATITUDE 

0.814E-05 

0.126E-07 

0.325E-04 

0.137E-07 

CNGITUDE 

0.552E-05 

0.119E-07 

-0.205E-04 

0.124E-07 
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MONTE    CARLO    SIMULATION    ERROR    ANALYSIS 
ESTIMATED    EMITTER    POSITION    ERROR    IN    NAUTICAL    MILES 
EXTENDED    KALMAN    FILTER 


EMITTER  # 

1 

EMITTER  # 

2 

RUN 

DLAT1 

DL0N1 

DRNG1 

DLAT2 

DL0N2 

DRNG2 

1 

-0.13275 

-2.06057 

2.06484 

-0.26367 

-4.77378 

4.78105 

2 

0.19501 

-0.20215 

0.28088 

0.13458 

4.61521 

4.61717 

3 

-0.41382 

-2.82782 

2.85794 

0.13458 

4.61521 

4.61717 

4 

7.08435 

15.22875 

16.79591 

0.13458 

4.61521 

4.61717 

5 

0.34973 

1.51996 

1.55968 

3.05878 

17.13541 

17.40627 

6 

0.52734 

2.15016 

2.21388 

-0.05127 

-6.19852 

6.19873 

7 

2.55524 

5.96270 

6.48715 

-0.05127 

-6.19852 

6.19873 

8 

-0.41016 

-6.43056 

6.44363 

-0.05127 

-6.19852 

6.19873 

9 

0.48  52  3 

1.84157 

1.90442 

0.76172 

-10.95459 

10.98104 

10 

0.36530 

-0.51840 

0.63417 

0.76172 

-10.95459 

10.98104 

11 

-0.01373 

-0.26877 

0.26912 

0.76172 

-10.95459 

10.98104 

12 

-0.24353 

-2.94039 

2.95045 

3.13110 

9.47674 

9.98060 

13 

-0.38086 

-4.55913 

4.57501 

0.79010 

-10.04171 

10.07274 

14 

0.46967 

1.21750 

1.3  0495 

2.88940 

17.06227 

17.30519 

15 

-0.51819 

-3.60121 

3.63830 

0.58685 

3.54069 

3.58900 

16 

0.15106 

-1.57663 

1.58385 

2.13318 

7.10832 

7.42150 

17 

4.17938 

9.80282 

10.65657 

-0.07782 

-4.01022 

4.01097 

18 

-0.48706 

-2.14326 

2.  19791 

-0.07782 

-4.01022 

4.01097 

19 

2.39960 

4.55683 

5.15003 

1.30096 

-14.17046 

14.23006 

20 

1.50421 

5.11581 

5.33237 

0.28839 

-9.11035 

9.11491 

21 

-0.06042 

-2.97637 

2.97699 

3.81042 

-19.66084 

20.02667 

22 

1.65253 

3.94042 

4.27291 

0.65552 

-9.76153 

9.78352 

23 

12.78076 

21.09802 

24.66727 

0.47241 

0.25247 

0.53564 

24 

0.21240 

-0.97324 

0.99615 

1.27991 

1.17305 

1.73615 

25 

1.19476 

3.26888 

3.48038 

0.67291 

-7.58709 

7.61687 

26 

-0.17303 

-4.62192 

4.62516 

0.67291 

-7.58709 

7.61687 

27 

5.29816 

9.67111 

11.02728 

-0.33142 

-0.94  059 

0.99727 

28 

-0.15198 

-7.01022 

7.01186 

0.08972 

3.94325 

3.94427 

29 

0.15839 

-1.37141 

1.38053 

-0.05310 

-8.21902 

8.21919 

30 

1.51886 

5.09590 

5.31744 

-0.05310 

-8.21902 

8.21919 

31 

0.22797 

2.07282 

2.08532 

1.58752 

-12.84886 

12.94656 

32 

5.62866 

8.69098 

10.35447 

0.97229 

5.07089 

5.16326 

33 

0.51544 

0.75654 

0.91544 

0.44403 

-8.21594 

8.22793 

34 

3.34991 

8.26371 

8.91688 

-0.39551 

-5.82290 

5.83631 

35 

-0.09430 

-2.87224 

2.87378 

-0.42114 

-4.47744 

4.49720 

36 

3.70972 

8.64734 

9.40949 

-0.42114 

-4.47744 

4.49720 

37 

1.31470 

3.19997 

3.45951 

0.28290 

-5.10475 

5.11258 

38 

-0.38177 

-3.53918 

3.55971 

0.02014 

-6.37016 

6.37020 

39 

2.58820 

5.81645 

6.36630 

0.33600 

-8.64621 

8.65274 

40 

-0.57129 

-6.08063 

6.10740 

1.60767 

-14.08425 

14.17571 

41 

-0.13458 

-1.26881 

1.27592 

2.94250 

13.34225 

13.66287 

42 

4.53186 

7.77977 

9.00348 

3.24005 

10.32419 

10.82067 

43 

4.18488 

9.18335 

10.09193 

-0.04852 

-6.79120 

6.79137 

44 

-0.40009  - 

-10.54251 

10.55010 

2.35657 

8.65006 

8.96532 

45 

-0.07507 

-1.51843 

1.52029 

0.31036 

-9.50906 

9.51413 

46 

-0.37354 

-5.63268 

5.64505 

2.11945 

-13.57008 

13.73460 

47 

-0.47241 

-3.34622 

3.37940 

0.07599 

-2.16906 

2.17039 

48 

2.00592 

7.79815 

8.05201 

0.19043 

-7.81723 

7.81955 

49 

0.11353 

-0.30629 

0.32665 

0.19043 

-7.81723 

7.81955 

50 

-0.00732 

-0.84077 

0.84080 

-0.10895 

-1.01371 

1.01955 

AVERAGE 

ERROR  IN  NAUTICAL  MILES 

AVERAGE 

AVERAGE 

AVERAGE 

AVERAGE 

AVERAGE 

AVERAGE 

LATITUDE  LONGITUDE    RANGE 

LATITUDE  LONGITUDE    RANGE 

RUNS    ERROR 

ERROR 

ERROR 

ERROR 

ERROR 

ERROR 

50 

1.53497 

4.65418 

4.98781 

0.87208 

7.78420 

7.87609 
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MONTE    CARLO    SIMULATION    ERROR    ANALYSIS 
ESTIMATED    EMITTER    POSITION    ERROR     IN    NAUTICAL    MILES 
BEARING    ANGLE-OF-ARRIVAL    FILTER 


EMITTER  # 

1 

EMITTER  # 

2 

RUN 

DLAT1 

DLCN1 

DRNG1 

DLAT2 

DL0N2 

DRNG2 

1 

-0.77362 

-0.96022 

1.23309 

-0.18036 

-0.03156 

0.18310 

2 

-0.81299 

0.41349 

0.91210 

-0.60333 

1.63641 

1.74409 

3 

-0.70770 

-1.31169 

1.49043 

0.12726 

1.13456 

1.14167 

4 

1.20026 

2.43424 

2.71406 

-0.60242 

1.38549 

1.51079 

5 

0.11078 

-0.15468 

0.19025 

-0.24078 

2.70863 

2.71931 

6 

-0.25635 

-1.06206 

1.09256 

-0.80383 

-2.49311 

2.61949 

7 

0.52826 

1.71829 

1. 79766 

0.97595 

-0.94367 

1.35757 

8 

-1.23230 

-1.55595 

1.98483 

-0.13092 

2.88797 

2.89094 

9 

0.27466 

-0.41732 

0.49959 

-1.48041 

-1.51403 

2.11752 

10 

0.41016 

-1.46790 

1.52412 

-0.29022 

3.01959 

3.03351 

11 

0.19409 

-2.42505 

2.43281 

0.66650 

1.50633 

1.64720 

12 

-0.81116 

-0.92500 

1.23028 

0.17944 

-0.24323 

0.30226 

13 

-1.43005 

-1.22133 

1.88061 

-0.69214 

-0.01770 

0.69237 

14 

0.14740 

0.57736 

0.59588 

-0.37170 

2.27605 

2.30620 

15 

-0.54565 

-2.34542 

2.40805 

-0.28290 

-0.16395 

0.32697 

16 

-0.0421  1 

-0.28332 

0.28643 

-0.74707 

0.21398 

0.77711 

17 

1.28174 

1.62793 

2.07196 

-0.36072 

-2.23910 

2.26797 

18 

-1.21674 

-C. 90279 

1.51508 

1.39160 

3.39214 

3.66649 

19 

-0.21698 

-1.59118 

1.60590 

-1.61499 

-2.44308 

2.92862 

20 

0.74249 

0.19143 

0.76677 

-1.17279 

-0.54650 

1.29387 

21 

-0.14282 

-0.58731  ' 

0.60443 

-0.93842 

-3.95942 

4.06910 

22 

0.70129 

-1.15548 

1.35165 

-0.60974 

-0.51648 

0.79908 

23 

0.56030 

-0.97171 

1. 12167 

-0.95673 

0.32944 

1.01186 

24 

-0.74799 

1.89134 

2.03388 

-0.66742 

-1.18921 

1.36370 

25 

-0.08514 

0.82162 

0.82602 

-0.36896 

-2.34686 

2.37569 

26 

-0.91919 

-1.17998 

1.49575 

0.76721 

0.91673 

1.19541 

27 

0.37811 

0.20215 

0.42876 

1.17462 

-1.32930 

1.77391 

28 

-0.92468 

-1.51690 

1.77652 

0.57404 

2.32223 

2.39213 

29 

-0.17303 

-0.72744 

0.74774 

-0,45593 

-2.55084 

2.59126 

30 

0.88531 

1.73743 

1.94999 

0.95123 

5.42342 

5.50620 

31 

-0.08331 

0.60492 

0.61063 

-1.28357 

-2.41537 

2.73524 

32 

1.21307 

-1.48704 

1.91907 

-0.70404 

1.98664 

2.10770 

33 

0.51270 

-0.83158 

0.97692 

-0.38635 

-1.90274 

1.94156 

34 

0.58319 

1.59501 

1.69828 

0.63263 

-1.83654 

1.94245 

35 

-0.76630 

-0.14625 

0.78013 

-1.66718 

2.10517 

2.68537 

36 

0.56854 

1.87450 

1.95882 

0. 11444 

4.54440 

4.54584 

37 

0.43396 

-2.07665 

2.12150 

-0.75531 

-2.24449 

2.36817 

38 

-0.95398 

-0.95486 

1.34975 

-0.61249 

-1.45322 

1.57702 

39 

0.62256 

-1.19377 

1.34635 

0.05219 

-2.86488 

2.86536 

40 

-1.44653 

-1.89823 

2.38658 

-1.62140 

-2.77405 

3.21315 

41 

-0.29388 

-0.91657 

0.96254 

0.19501 

2.32531 

2.33347 

42 

0.32593 

1.00846 

1.05982 

-0.05127 

1.33546 

1.33  644 

43 

1.08032 

0.27030 

1. 11362 

-1.89514 

-0.38101 

1.93306 

44 

-1.64886 

-2.81710 

3.26417 

-0.34149 

2.46309 

2.48665 

45 

-1.29272 

0.55285 

1  .40598 

-1.14624 

-1.53096 

1.91252 

46 

-0.74982 

-2.17236 

2.29813 

0.02655 

-1.00448 

1.00483 

47 

-1.05377 

-0.67843 

1.25328 

-0.94391 

-0.78357 

1.22676 

48 

1.37787 

-0.28638 

1.40732 

-0.77545 

-3.45987 

3.54571 

49 

-0.39276 

-0.20368 

0.44243 

0.67017 

3.63768 

3.69889 

50 

-0.39276 

0.50614 

0.64066 

-0.18494 

0.78973 

0.81109 

AVERAGE  ERROR  IN  NAUTICAL  MILES 

AVERAGE 

AVERAGE 

AVERAGE 

AVERAGE 

AVERAGE 

AVERAGE 

LATITUDE  LONGITUDE 

RANGE 

LATITUDE  LONGITUDE 

RANGE 

RUNS    ERROR 

ERROR 

ERROR 

ERROR 

-•   ERROR 

ERROR 

50 

0.68492 

1.12906 

1.39129 

0.68879 

1.87039 

2.09753 
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LISTING  OF  EMITTER  TARGET  DATA 


K 

TIMET 

FREO 

PRF 

PW 

BRNGD 

THETAD 

1 

100.0 

1197.0 

150.0 

3.50 

105.98349 

106.81114 

2 

106.0 

1212.0 

250.0 

3.00 

123.17577 

124. 30956 

3 

112.0 

1197.0 

150.0 

3.50 

104.01610 

104.26736 

4 

118.0 

1212.0 

250.0 

3.00 

121.91071 

122.41992 

5 

124.0 

1197.0 

150.0 

3.50 

102.01436 

102.41859 

6 

130.0 

1212.0 

250.0 

3.00 

120.60915 

121.18193 

7 

136.0 

1197.0 

150.  0 

3.50 

99.98351 

100.68506 

8 

142.0 

1212.0 

250.0 

3.00 

119.27164 

118.74664 

9 

148.0 

1197.0 

150.0 

3  .50 

97.92696 

96.78751 

0 

154.0 

1212.0 

250.0 

3.00 

117.89893 

118.73015 

1 

160.0 

1197.0 

150.0 

3.50 

95.84862 

94.37448 

2 

166.0 

1212.0 

250.  0 

3.00 

116.49051 

116.33717 

3 

172.0 

1197.0 

150.0 

3.50 

93. 75478 

94.24924 

4 

178.0 

1212.0 

250.0 

3.00 

115.04587 

116.48721 

5 

184.0 

1197.0 

150.0 

3.50 

91.65182 

92.49257 

6 

190.0 

1212.0 

250.0 

3.00 

113.56721 

113.94238 

7 

196.0 

1197.0 

150.0 

3.50 

89.54355 

90.58488 

8 

202.0 

1212.0 

250.  0 

3.00 

112.05394 

112.42679 

9 

208.0 

1197.0 

150.0 

3.50 

87.43718 

85. 53748 

0 

214.0 

1212.0 

250.0 

3.00 

110.50731 

109.75629 

1 

220.0 

1197.0 

150.0 

3.50 

85.33707 

87.01108 

2 

226.0 

1212.0 

250.0 

3.00 

103.92969 

108.96266 

3 

232.0 

1197.0 

150.0 

3.50 

83.24927 

83.44542 

4 

238.0 

1212.0 

250.0 

3.00 

107.32155 

108.41565 

5 

244.0 

1197.0 

150.0 

3  .50 

81  .18033 

81.18315 

6 

250.0 

1212.0 

250.  0 

3.00 

105.68427 

105.95073 

7 

256.0 

1197.0 

150.0 

3.50 

79. 13434 

79. 59174 

8 

262.0 

1212.0 

250.0 

3.00 

104.02003 

104.99403 

9 

268.0 

1197.0 

150.0 

77.11496 

77, 19061 

0 

2  74.0 

1212.0 

250.0 

3.00 

102.33228 

103.68779 

1 

280.0 

1197.0 

150.  0 

3.50 

75.12862 

73.77927 

2 

286.0 

1212.0 

250.0 

3.00 

100.62157 

100.01122 

3 

292.0 

1197.0 

150.0 

3.50 

73.17722 

72.55504 

4 

298.0 

1212.0 

250.0 

3.00 

98.89243 

97.91229 

5 

304.0 

1197.0 

150.0 

3.50 

71.26514 

72.24512 

6 

310.0 

1212.0 

250.0 

3.00 

97. 14586 

96.42537 

7 

316.0 

1197.0 

150.0 

3.50 

69.39635 

68.22856 

8 

322.0 

1212.0 

250.0 

3.00 

95.38602 

94.80276 

9 

328.0 

1197.0 

150.0 

3.50 

67.57230 

67.65929 

0 

334.0 

1212.0 

250.0 

3.00 

93.61652 

93.63611 

1 

340.0 

1197.0 

150.0 

3.50 

65.79401 

66.59315 

2 

346.0 

1212.0 

250.0 

3.00 

91.84023 

89.98112 

3 

352.0 

1197.0 

150.0 

3.50 

64.06415 

63.11497 

4 

358.0 

1212.0 

250.0 

3.00 

90.05968 

91.48303 

5 

3  64.0 

1197.0 

150.0 

3.50 

62.38416 

60.46066 

6 

370.0 

1212.0 

250.0 

3.00 

88.27945 

87.50397 

7 

376.0 

1197.0 

150.0 

3.50 

60.75365 

61.14169 

8 

382.0 

1212.0 

250.0 

3.00 

86.50214 

87.24391 

9 

388.0 

1197.0 

150.0 

3.50 

59. 17412 

57.07373 

0 

394.0 

1212.0 

250.0 

3.00 

84.73131 

85.86865 

1 

400.0 

1197.0 

150.  0 

3.50 

57.64409 

56.69685 

2 

406.0 

1212.0 

250.0 

3.00 

82.97147 

84.63478 

3 

412.0 

1197.0 

150.0 

3.50 

56.16422 

57.10556 

4 

418.0 

1212.0 

250.0 

3.00 

81.22481 

81.01143 

5 

424.0 

1197.0 

150.0 

3.50 

54.73453 

55. 17111 

6 

430.0 

1212.0 

250.0 

3.00 

79.49355 

80.80753 

7 

436.0 

1197.0 

150.  0 

3.50 

53.35355 

54.66557 

8 

442.0 

1212.0 

250.0 

3.00 

77.78148 

77.29852 

9 

448.0 

1197.0 

150.0 

3.50 

52.01973 

52.38834 

0 

454.0 

1212.0 

250.0 

3.00 

76.09212 

76.34935 

1 

460.0 

1197.0 

150.0 

3.50 

50.73331 

52.29285 

76 


AIRCRAFT  NAVIGATION  COMPUTER  DATA 

ACTUAL    NOISY    SMOOTHED    ACTUAL      NOISY      SMOOTHED 
LATITUDE  LATITUDE  LATITUDE   LONGITUDE   LONGITUDE   LONGITUDE 


1 
2 
3 
4 
5 
6 
7 
8 
9 
10 
11 
12 
13 
14 
15 
16 
17 
18 
19 
20 
21 
22 
23 
24 
25 
26 
27 
28 
29 
30 
31 
32 
33 
34 
35 
36 
37 
38 
39 
40 
41 
42 
43 
44 
45 
46 
47 
48 
49 
50 
51 
52 
53 
54 
55 
56 
57 
58 
59 
60 
61 


33 
33 
33 
33 
33 
33 
33 
33 
33 
33 
33 
33 
33 
33 
33 
33 
33 
33 
33 
33 
33 
33 
33 
33 
33 
33 
33 
33 
33 
33 
33 
32 
32 
32 
32 
32 
32 
32 
32 
32 
32 
32 
32 
32 
32 
32 
32 
32 
32 
32 
32 
32 
32 
32 
32 
32 
32 
32 
32 
32 
32 


.5000 
.4833 
.4667 
.4500 
.4333 
.4167 
.4000 
.3833 
.3667 
.3500 
.3333 
.3167 
.3000 
.2833 
.2667 
.2500 
.2333 
.2167 
.2000 
.1833 
.1667 
.1500 
.1333 
.1167 
.1000 
.0833 
.0667 
.0500 
.0333 
.0167 
.0000 
.9833 
.9667 
.9500 
.9333 
.9167 
.9000 
.8833 
.8667 
.8500 
.8333 
.8167 
.8000 
.7833 
.7667 
.7500 
.7333 
.7167 
.7000 
.6833 
.6667 
.6500 
.6333 
.6167 
.6000 
.5833 
.5667 
.5500 
.5333 
.5167 
.5000 


33.5007 
33.4841 
33.4679 
33.4505 
33.4332 
33.4167 
33  .3999 
33.3836 
33.3667 
33.3498 
33.3322 
33.3166 
33.2995 
33.2834 
33.2674 
33.2480 
33.2327 
33.2155 
33.1997 
33.1831 
33.1673 
33.1494 
33.1328 
33.1172 
33 .0992 
33.0832 
33.0660 
33.0490 
33.0329 
33.0162 
32.9988 
32.9831 
32.9655 
32.9501 
32.9315 
32.9183 
32.8998 
32.8841 
32.8688- 
32.8509 
32.8338 
32.8158 
32.79  94 
32.7833 
32  .7688 
32.7488 
,7322 
7177 
,7002 
,6824 
32.6661 
32.6497 


32, 
32, 
32, 
32 


32 

32. 

32, 

32, 

32, 

32 

32, 

32. 

32, 


6346 
6171 
6000 
5843 
5660 
5497 
5330 
5165 
4999 


33.5007 
33.4841 
33.4676 
33.4504 
33.4333 
33.4166 
33.4001 
33.3834 
33.3666 
33.3495 
33. 3328 
33.3162 
33.2999 
33.2835 
33.2662 
33.2491 
33.2322 
33.2158 
33.1996 
33.1833 
33.  1665 
33.1497 
33.1332 
33.  1164 
33.0997 
33.0828 
33.0659 
33.0493 
33.0327 
33.0159 
32.9993 
32.9826 
32.9660 
32.9491 
32.9331 
32.9167 
32.9005 
32.8846 
32.8681 
32.8510 
32.8334 
32.8162 
32.7998 
32.7839 
32.7668 
32.7496 
32.7332 
32.7168 
32.6998 
32.6828 
32.6662 
32.6502 
32.6338 
32.6172 
32.6005 
32.5835 
32. 5665 
32.5496 
32.5330 
32.5164 
32.4999 


-118. 
-118. 
-118. 
-118. 
-118. 
-118. 
-118. 
-118. 
-118. 
-118. 
-118. 
-118. 
-118. 
-118. 
-118. 
-118. 
-118. 
-118. 
-118. 
-118. 
-118. 
-118. 
-118. 
-118. 
-118. 
-118, 
-118. 
-118. 
-118. 
-118. 
-118. 
-118. 
-118. 
-118. 
-118. 
-118. 
-118. 
-118. 
-118. 
-118. 
-118. 
-118. 
-118. 
-118. 
-118. 
-118. 
-118. 
-118. 
-118. 
-118. 
-118. 
-118. 
-118. 
-118. 
-118. 
-118. 
-118. 
-118. 
-118. 
-118. 
-118. 


5000 
5000 
5000 
5000 
5000 
5000 
5000 
5000 
5000 
5000 
5000 
5000 
5000 
5000 
5000 
5000 
5000 
5000 
5000 
5000 
5000 
5000 
5000 
5000 
5000 
5000 
5000 
5000 
5000 
5000 
5000 
5000 
5000 
5000 
5000 
5000 
5000 
5000 
5000 
5000 
5000 
5000 
5000 
5000 
5000 
5000 
5000 
5000 
5000 
5000 
5000 
5000 
5000 
5000 
5000 
5000 
5000 
5000 
5000 
5000 
5000 


118. 
■118. 

113. 
•118. 
•118. 
■118. 

118. 
-118. 

118. 
■118. 
■118. 
•118. 

118. 

118. 

118. 
•118. 

118. 
■118. 
•118. 
■118. 
■118. 

118. 
■118. 
■118. 
•118. 
■118. 
■118. 

118. 
■118. 

118. 
■118. 
•118. 
■118. 
•118. 
•118. 

118. 
•118. 

118. 
•118. 
•118. 
•118. 
•118. 
-118. 
•118. 
■118. 
•118. 

118. 
•118. 
•118. 
•118. 

118. 
•118. 
■118. 
•118. 

118. 

118. 
•118. 
■  1.1  8 . 
•118. 
■118. 
•118. 


5012 
5003 
5019 
4985 
5007 
4997 
4992 
5006 
5006 
4994 
5007 
4985 
5010 
5002 
5005 
5011 
5001 
4986 
5004 
4985 
5005 
5007 
5011 
4991 
5005 
4996 
5010 
4995 
5000 
4995 
5000 
4996 
4992 
4997 
5008 
5013 
5005 
4993 
4990 
5003 
5013 
5003 
4998 
4998 
5001 
5016 
5006 
5001 
4993 
5002 
4997 
5001 
4998 
4998 
4996 
5000 
5007 
4997 
4996 
5004 
5004 


•118. 

118. 
•118. 
•118. 
•118. 
•118. 

118. 
■118. 
•118. 
•118. 
■118. 
•118. 
•118. 
•118. 
•118. 
■118. 
•118. 
•118. 
■118. 

118. 
■118. 
•118. 
•118. 
-118. 
-118. 
•118. 
•118. 

118. 
-118. 
•118. 
•118. 
•118. 
-118. 
•118. 
-118. 

118. 
-118. 
•118. 
•118. 
-118. 
-118. 
-118. 
■118. 
-118. 
•118. 
■118. 
-118. 
-118. 
•118. 
-118. 
-118. 
-118. 
•118. 
-118. 
-118. 
-118. 
-118. 
-118. 
-118. 
-118. 
-118. 


5011 
5003 
5008 
4999 
4999 
4998 
4997 
5001 
5003 
5000 
4999 
4996 
5001 
5004 
5006 
5007 
5001 
4995 
4995 
4994 
5000 
5005 
5006 
5000 
5000 
5000 
5002 
5000 
4998 
4997 
4997 
4996 
4995 
4998 
5005 
5  009 
5005 
4997 
4994 
5000 
5007 
5007 
5002 
5000 
5002 
5008 
5007 
5002 
4997 
4998 
4998 
4999 
4999 
4998 
4998 
5000 
5002 
5000 
4999 
5002 
5004 
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NAVIGATION  DATA  FILTER  PARAMETERS 


SGI 


SG2 


SP11 


SP12 


SP22 


1 

0.0 

0  . 

0 

1.00000 

0.0 

1.00000 

0.0 

2 

0.99999 

0. 

16216 

37.00000 

6.00000 

1.00004 

6.00 

3 

0.99957 

0. 

16646 

0.97585 

0.16251 

0.02711 

6.00 

4 

0.89002 

0. 

11174 

0.00337 

0.00042 

0.00009 

6.00 

5 

0.86395 

0. 

10864 

0.00265 

0.00033 

0.00008 

6.00 

6 

0.86253 

0. 

10906 

0.00261 

0.00033 

0.00008 

6.00 

7 

0.86251 

0. 

10903 

0.00261 

0.00033 

0.00008 

6.00 

8 

0.86246 

0. 

10901 

0.00261 

0.00033 

0.00008 

6.00 

9 

0.86246 

0. 

10931 

0.00261 

0.00033 

0.00008 

6.0  0 

10 

0.86246 

0. 

10901 

0.00261 

0.00033 

0.00008 

6.00 

11 

0.86246 

0. 

10901 

0.00261 

0.00033 

0. 00008 

6.  00 

12 

0.86246 

0. 

10901 

0.00261 

0.00033 

0.00008 

6.00 

13 

0.86246 

0. 

10901 

0.00261 

0.00033 

0.00008 

6.00 

14 

0.86246 

0. 

10901 

0.00261 

0.00033 

0.00008 

6.00 

15 

0.86246 

0. 

10901 

0.00261 

0.00033 

0.00008 

6.00 

16 

0.86246 

0. 

10901 

0.00261 

0.00033 

0.00008 

6.00 

17 

0.86246 

0. 

10901 

0.00261 

0.00033 

0.00008 

6.00 

18 

0.86246 

0. 

10901 

0.00261 

0.00033 

0.00008 

6.00 

19 

0.86246 

0. 

10901 

0.00261 

0.00033 

0.00008 

6.00 

20 

0.86246 

0. 

10901 

0.00261 

0.00033 

0.00008 

6.00 

21 

0. 86246 

0. 

10901 

0.00261 

0.00033 

0.00008 

6.00 

22 

0.86246 

0. 

10901 

0.00261 

0.00033 

0.00008 

6.00 

23 

0. 86246 

0. 

10901 

0.00261 

0.00033 

0.00008 

6.00 

24 

0.86246 

0. 

10901 

0.00261 

0.00033 

0.00008 

6.00 

25 

0.86246 

0. 

,10901 

0.00261 

0.00033 

0.00008 

6.00 

26 

0.86246 

0. 

10901 

0.00261 

0.00033 

0.00008 

6.00 

27 

0.86246 

0. 

10901 

0.00261 

0.00033 

0.00003 

6.00 

28 

0.86246 

0. 

10901 

0.00261 

0.00033 

0.00003 

6.00 

29 

0.86246 

0. 

10901 

0.00261 

0.00033 

0.00008 

6.00 

30 

0.86246 

0. 

10901 

0.00261 

0.00033 

0.00008 

6.00 

31 

0.86246 

0. 

10901 

0.00261 

0.00033 

0.00008 

6.00 

32 

0.86246 

0. 

10901 

0.00261 

0.00033 

0. 00008 

6.00 

33 

0.86246 

0. 

,10901 

0.00261 

0.00033 

0.00008 

6.00 

34 

0.86246 

0. 

10901 

0.00261 

0.00033 

0.00008 

6.00 

35 

0.86246 

0. 

10901 

0.00261 

0.00033 

0.00008 

6.00 

36 

0.86246 

0. 

10901 

0.00261 

0.00033 

0.00008 

6.00 

37 

0.86246 

0. 

10901 

0.00261 

0.00033 

0.00008 

6.00 

38 

0.86246 

0. 

,  10901 

0.00261 

0.00033 

0.00008 

6.00 

39 

0.86246 

0. 

10901 

0.00261 

0.00033 

0.00008 

6.00 

40 

0.86246 

0. 

10901 

0.00261 

0.00033 

0. 00008 

6.00 

41 

0.86246 

0. 

,10901 

0.00261 

0.00033 

0.00003 

6.00 

42 

0.86246 

0. 

10901 

0.00261 

0.00033 

0.00008 

6.00 

43 

0.86246 

0. 

10901 

0.00261 

0.00033 

0.00008 

6.00 

44 

0.86246 

0. 

10901 

0.00261 

0.00033 

0.00008 

6.00 

45 

0.86246 

0. 

10901 

0.00261 

0.00033 

0.00008 

6.00 

46 

0.86246 

0. 

,10901 

0.00261 

0.00033 

0.00008 

6.00 

47 

0.86246 

0. 

10901 

0.00261 

0.00033 

0.00008 

6.00 

48 

0.86246 

0. 

10901 

0.00261 

0.00033 

0. 00008 

6.00 

49 

0.86246 

0. 

,10901 

0.00261 

0.00033 

0.00008 

6.00 

50 

0.86246 

0. 

10901 

0.00261 

0.00033 

0.00008 

6.00 

51 

0.86246 

0. 

,10901 

0.00261 

0.00033 

0. 00008 

6.00 

52 

0.86246 

0. 

10901 

0.00261 

0.00033 

0.00008 

6.00 

53 

0.86246 

0. 

10901 

0.00261 

0.00033 

0.00008 

6.00 

54 

0.86246 

0. 

,10901 

0.00261 

0.00033 

0.00008 

6.00 

55 

0.86246 

0. 

,10901 

0.00261 

0.00C33 

0.00008 

6.00 

56 

0.86246 

0. 

,10901 

0.00261 

0.00033 

0. 00008 

6.00 

57 

0.86246 

0. 

.10901 

0.00261 

0.00033 

0.00008 

6.00 

58 

0.86246 

0. 

10901 

0.00261 

0.00033 

0.00008 

6.00 

59 

0.8  6  246 

0. 

,10901 

0.00261 

0.00033 

0.00008 

6.00 

60 

0.86246 

0. 

10901 

0.00261 

0.00033 

0.00008 

6.00 

61 

0.86246 

0. 

.  10901 

0.00261 

0.00033 

0.00008 

6.00 
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NAVIGATION    DATA    FILTER    PARAMETERS 


VELND 


FLAT 


SLATD 


VELED 


ELON 


SLOND 


1  -0. 

2  -0. 

3  -0. 

4  -0. 

5  -0. 

6  -0. 

7  -0. 

8  -0. 

9  -0. 

10  -0. 

11  -0. 

12  -0. 

13  -0. 

14  -0. 

15  -0. 

16  -0. 

17  -0. 

18  -0. 

19  -0. 

20  -0. 
21-0. 

22  -0. 

23  -0. 

24  -0. 

25  -0. 

26  -0. 

27  -0. 

28  -0. 

29  -0. 

30  -0. 

31  -0. 

32  -0. 

33  -0. 

34  -0. 

35  -0. 

36  -0. 

37  -0. 

38  -0. 

39  -0. 

40  -0. 

41  -0. 

42  -0. 

43  -0. 

44  -0. 

45  -0. 

46  -0. 

47  -0. 

48  -0. 

49  -0. 

50  -0. 

51  -0. 

52  -0. 

53  -0. 

54  -0. 

55  -0. 

56  -0. 

57  -0. 

58  -0. 

59  -0. 

60  -0. 

61  -0. 


00225 
00225 
00316 
00290 
00282 
00288 
00273 
00256 
00284 
C0279 
0  0284 
00270 
00279 
00273 
00291 
00278 
00275 
C0278 
00281 
00256 
00298 
C0276 
00260 
00277 
00294 
00262 
00280 
00278 
00280 
00274 
00275 
0  0  282 
00279 
00277 
00274 
00272 
00295 
00280 
00260 
00280 
00277 
00274 
00277 
00285 
00299 
00265 
C0270 
00282 
00277 
00290 
00271 
00266 
00287 
00270 
C0295 
00260 
00283 
00285 
00263 
00278 
00268 


0.0 

0.0 
-0  .00546 

0.00235 

0.00075 
-0.00063 

0.00140 

0.00162 
-0.00266 

0.00052 
-0.00050 

0.00134 
-0.00089 

0.00055 
-0.00160 

0.00113 

0.00032 
-0.00029 
-0.00031 

0.00233 
-0.00383 

0.00197 

0.00153 
-0.00163 
-0.00154 

0.00294 

0.00017 

-0.00018 

0.00058 

-0.00006 

-0.00072 

0.00035 

0.00015 

0.00024 

0.00024 

-0.00212 

0.00133 

0.00186 

-0.00186 

0.00031 

0.00024 

-0.00027 

-0.00067 

-0.00130 

3.00305 

-0.00040 

-0.00116 

0.00047 

-0.00119 

0  .00172 

0.00050 

-0.00189 

0.00150 

-0.00229 

0.00323 

-0.00212 

-0.00015 

0  .00200 

-0.00134 

0.00092 


33.49908 
33.48558 
33.47208 
33.44765 
33.43234 
33.41608 
33.39821 
33.38303 
33.36908 
33.34970 
33.33340 
33.31590 
33.30086 
33.28333 
33.26740 
33.24855 
33.23280 
33.21657 
33.19962 
33.18245 
33. 16908 
33.14790 
33. 13301 
33.11874 
33.10068 
33.08167 
33.06847 
33.05022 
33.03365 
33.01665 
33.00069 
32.98415 
32.96657 
32.95013 
32.93364 
32.91737 
32.90126 
32.88174 
32.866  06 
32.85205 
32.83360 
32.81725 
32.80098 
32.78409 
32.76642 
32.74736 
32.73405 
32.71751 
32.69955 
32.68330 
32.66484 
32.65002 
32.63449 
32.61566 
32.60072 
32.58102 
32.56819 
32.54936 
32.53214 
32.51805 
32.50023 


0.00003 

0. 00003 

•0.00001 

0.00000 

•0.00012 

0.00012 

■0.00010 

■0.00016 

0.00015 

0.00010 

0.00014 

-0.00008 

■0.00005 

0.00006 

-0.00012 

0.00003 

0.00014 

■0.00006 

■0.00001 

-0.00010 

■0.00002 

0.00001 

0.00009 

■0.00004 

0.00001 

•0. 00008 

0.00002 

0.00004 

0.00003 

-0.00011 

-0.00005 

0.00000 

0.00008 

0.00014 

-0.00002 

0.00001 

■0.00005 

0.00002 

-0.00018 

0.00008 

0.00007 

0.00005 

-0.00008 

-0.00002 

-0.00000 

0.00005 

-0.00002 

0.00011 

-0.00007 

-0. 00000 

0.00004 

-0.00003 

-0. 00016 

0.00008 

0.00005 

■0.00003 

-0.00011 

-0.00001 

0.00006 

-0.00007 

0.00007 


0.0 
0.00003 

■0.00023 
0.00011 

■0.00132 
0.00239 

■0.00224 

•0.00080 
0.00310 

-0.00029 
0.00061 

-0.00213 
0.00014 
0.00114 

-0.00185 
0.00139 
0.00130 

■0.00195 
0.00046 

•0.00103 
0.00068 
0.00036 
0.00082 

•0.00128 
0.00049 

•0.00093 
0.00095 
0,00031 

•0.00012 

■C. 00142 
0.00049 
0.00044 
0.00088 
0.00074 

•0.00152 
0.00033 

•0.00065 
0.00073 

■0.00223 
0.00256 
0.00003 

-0.00012 

■0.00135 
0.00058 
0.00014 
0.00051 

•0.00063 
0.00141 

■0.00178 
0.00059 
0.00044 

■0.00071 

■0.00139 
0.00233 

•0.00023 

•0.00081 

■0.00089 
0.00090 
0.00075 

•0.00127 
0.00133 


•118. 
■118. 

118. 

118. 
•118. 

118. 
•118. 
•118. 
•118. 
•118. 

118. 
•118. 
■118. 

118. 
-118. 
■118. 

118. 
•118. 

118. 
•118. 
■118. 

118. 
■118. 

118. 

118. 
•118. 

118. 
■118. 

118. 

118. 
■118. 
•118. 

118. 
-118. 

118. 
•118. 
■118. 

118. 
•118. 
■118. 

118. 
-118. 

118. 
■118. 
•118. 

118. 
•118. 
■118. 
■118. 
■118. 

118. 
•118. 

118. 
■118. 
•118. 
•118. 
■118. 
■118. 

118. 
■118. 

118. 


50040 
50020 
49998 
50024 
50011 
50192 
499  11 
50165 
50328 
49971 
49936 
49799 
50029 
50047 
49911 
50140 
50003 
49805 
50008 
49973 
50121 
50075 
50034 
49910 
50046 
49998 
50125 
50031 
49976 
49968 
50154 
50137 
50098 
49971 
49825 
49969 
49934 
50020 
49940 
50243 
49973 
49927 
49907 
50072 
50031 
50018 
49947 
50011 
49820 
50012 
49962 
49901 
49980 
50192 
49940 
49931 
50020 
50162 
50089 
49986 
50134 
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KALMAN    FILTER    PARAMETERS    FOR    ANGLE    FILTER 


I 

J 

K 

Pll(K) 

P12(K) 

G 1  (  K  ) 

G2(K) 

0 

1 

10000.0000 

0.0 

0.9999 

0.0 

2 

3 

1440001 .0000 

120000.0000 

1.0000 

0.0833 

3 

5 

6.8125 

0.3202 

0.8720 

0.0410 

4 

7 

2.7990 

0. 1196 

0.7368 

0.0315 

5 

9 

1.9142 

0.0666 

0.6569 

0.0229 

6 

11 

1.4289 

0.0415 

0.5883 

0.0171 

7 

13 

1.1400 

0.0289 

0.5327 

0.0135 

8 

15 

0.9634 

0.0224 

0.4907 

0.0114 

9 

17 

0.8548 

0.0189 

0.4608 

0.0102 

10 

19 

0.7893 

0.0172 

0.4411 

0.0096 

11 

21 

0.7517 

0.0163 

0.4291 

0.0093 

12 

23 

0.7317 

0.0159 

0.4225 

0.0092 

13 

25 

0.7221 

0.0158 

0.4193 

0.0092 

14 

27 

0.7181 

0.0157 

0.4179 

0.0092 

15 

29 

0.7167 

0.0157 

0.4175 

0.0092 

16 

31 

0.7164 

0.0157 

0.4174 

0.0092 

17 

33 

0.7163 

0.0157 

0.4174 

0.0092 

18 

35 

0.7162 

0.0157 

0.4173 

0.0092 

19 

37 

0.7161 

0.0157 

0.4173 

0.0092 

20 

39 

0.7160 

0.0157 

0.4172 

0.0092 

21 

41 

0.7159 

0.0157 

0.4172 

0.0092 

22 

43 

0.7158 

0.0157 

0.4172 

0  .0092 

23 

45 

0.7157 

0.0157 

0.4172 

0.0092 

24 

47 

0.7157 

0.0157 

0.4172 

0.0092 

25 

49 

0.7157 

0.0157 

0.4171 

0.0092 

26 

51 

0.7157 

0.0157 

0.4171 

0.0092 

27 

53 

0.7157 

0.0157 

0.4171 

0.0092 

28 

55 

0.7157 

0.0157 

0.4171 

0.0092 

29 

57 

0.7157  ' 

0.0157 

0.4171 

0.0092 

30 

59 

0.7157 

0.0157 

0.4171 

0.0092 

31 

61 

0.7157 

0.0157 

0.4171 

0.0092 

2 

0 

2 

10000.0000 

0.0 

0.9999 

0.0 

2 

2 

4 

1440001.0000 

120000.0000 

1.0000 

0.0833 

2 

3 

6 

6.8125 

0.3202 

0.8720 

0.0410 

2 

4 

8 

2.7990 

0.1196 

0.7368 

0.0315 

2 

5 

10 

1.9142 

0.0666 

0.6569 

0.0229 

2 

6 

12 

1.4289 

0.0415 

0.5883 

0.0171 

2 

7 

14 

1.1400 

0.0289 

0.5327 

0.0135 

2 

8 

16 

0.9634 

0.0224 

0.4907 

0.0114 

2 

9 

18 

0.8548 

0.0189 

0.4608 

0.0102 

2 

10 

20 

0.7893 

0.0172 

0.4411 

0.0096 

2 

11 

22 

0.7517 

0.0163 

0.4291 

0.0093 

2 

12 

24 

0.7317 

0.0159 

0.4225 

0.0092 

2 

13 

26 

0.7221 

0. 0158 

0.4193 

0.0092 

2 

14 

28 

0.7181 

0.0157 

0.4179 

0.0092 

2 

15 

30 

0.7167 

0.0157 

0.4175 

0.0092 

2 

16 

32 

0.7164 

0.0157 

0.4174 

0.0092 

2 

17 

34 

0.7163 

0.0157 

0.4174 

0.0092 

2 

18 

36 

0.7162 

0.0157 

0.4173 

0.0092 

2 

19 

38 

0.7161 

0.0157 

0.4173 

0.0092 

2 

20 

40 

0.7160 

0.0157 

0.4172 

0.0092 

2 

21 

42 

0.7159 

0.0157 

0.4172 

0.0092 

2 

22 

44 

0.7158 

0.0157 

0.4172 

0.0092 

2 

23 

46 

0.7157 

0.0157 

0.4172 

0.0092 

2 

24 

48 

0.7157 

0.0157 

0.4172 

0.0092 

2 

25 

50 

0.7157 

0.0157 

0.4171 

0.0092 

2 

26 

52 

0.7157 

0.0157 

0.4171 

0.0092 

2 

27 

54 

0.7157 

0.0157 

0.4171 

0.0092 

2 

28 

56 

0.7157 

0.0157 

0.4171 

0.0092 

2 

29 

58 

0.7157 

0.0157 

0.4171 

0.0092 

2 

30 

60 

0.7157 

0.0157 

0.4171 

0.0092 
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KALMAN    FILTER    PARAMETERS    FOR    ANGLE    FILTER 


I 

J 

K 

TOO 

THTD(K) 

TDTD(K) 

E(K) 

GATE(K) 

0 

1 

0.0 

10  6. 68  54 

0. 0930 

2 

3 

12.000 

104.1513 

-0.2112 

-3.6504 

3600.0022 

3 

5 

12.000 

102.3046 

-0.1789 

0.7882 

8.3853 

4 

7 

12.000 

100.2979 

-0.1729 

0.  1896 

5.8473 

5 

9 

12.000 

98.7523 

-0.1545 

0.8055 

5.1213 

6 

11 

12.000 

96.2384 

-0.1736 

-1.1222 

4.6754 

7 

13 

12.000 

93.7121 

-0.1849 

-0.8310 

4.3886 

8 

15 

12.000 

92. 1992 

-0.1685 

1.43  76 

4.2036 

9 

17 

12.000 

88.9479 

-0.1957 

-2.6682 

4.0857 

10 

19 

12.000 

87.1063 

-0.1847 

1.1494 

4.0130 

11 

21 

12.00  0 

85.4691 

-0. 1721 

1.3497 

3.9706 

12 

23 

12.000 

83.4872 

-0.1703 

0.1983 

3.9478 

13 

25 

12.000 

81.0928 

-0.1780 

-0.8360 

3.9368 

14 

27 

12.000 

78.6840 

-0. 1840 

-0.6535 

3.9322 

15 

29 

12.000 

76.7533 

-0.1779 

0.6632 

3.9307 

16 

31 

12.000 

74.8173 

-0.1735 

0.4758 

3.9303 

17 

33 

12.000 

73.1776 

-0. 1638 

1.0604 

3.9302 

18 

35 

12.000 

71.3  944 

-0.1598 

0.4371 

3.9301 

19 

37 

12.00  0 

68.8458 

-0. 1737 

-1.5126 

3.9300 

20 

39 

12.000 

66.4753 

-0.1799 

-0.6871 

3.9299 

21 

41 

12.000 

64.3785 

-0.1786 

0.1502 

3.9297 

22 

43 

12.000 

62.9310 

-0. 1633 

1.  6668 

3.9296 

23 

45 

12.000 

62.0470 

-0.1397 

2.5784 

3.9296 

24 

47 

12.000 

60.6745 

-0.1330 

0.7282 

3.9296 

25 

49 

12.00  0 

59.0022 

-0. 1347 

-0. 1829 

3.9295 

26 

51 

12.000 

56.8325 

-0.1468 

-1.3267 

3.9295 

27 

53 

12.000 

55.2973 

-0.1419 

0.5438 

3.9295 

28 

55 

12.000 

53.6019 

-0.1417 

0.0165 

3.9295 

29 

57 

12.000 

52.4651 

-0. 1293 

1.3513 

3.9295 

30 

59 

12.00  0 

51.7908 

-0.1101 

2.  1038 

3.9295 

31 

61 

12.000 

50.6026 

-0.  1071 

0.3174 

3.9295 

2 

0 

2 

0.0 

123.  1348 

0.0810 

2 

2 

4 

12.00  0 

122.4821 

-0.0544 

-1.6245 

3600.0022 

2 

3 

6 

12.000 

120.9605 

-0.0952 

-0.9966 

8.3853 

2 

4 

8 

12. CCO 

118.2154 

-0.1637 

-2. 1748 

5.8473 

2 

5 

10 

12.000 

116.7974 

-0.1447 

0.8319 

5.1213 

2 

6 

12 

12.000 

115.7090 

-0.1259 

1.1009 

4.6754 

2 

7 

14 

12.000 

114.5483 

-0. 1170 

0.6568 

4.3886 

2 

8 

16 

12.000 

113.1856 

-0.1160 

0.0343 

4.2036 

2 

9 

18 

12.000 

111.6861 

-0. 1184 

-0.2320 

4.0857 

2 

10 

20 

12.000 

109.9158 

-0.1260 

-0.7919 

4.0130 

2 

11 

22 

12.000 

108.6817 

-0.1200 

0.6479 

3.9706 

2 

12 

24 

12.000 

107.5498 

-0.1133 

0.7287 

3.9478 

2 

13 

26 

12.000 

105.9513 

-0.1185 

-0.5700 

3.9368 

2 

14 

28 

12*000 

104.4048 

-0.1212 

-0.2975 

3.9322 

2 

15 

30 

12.000 

102.5540 

-0.1299 

-0.  9485 

3.9307 

2 

16 

32 

12.000 

100.6689 

-0. 1371 

-0.7811 

3.9303 

2 

17 

34 

12.000 

99. 1687 

-0.1339 

0.3474 

3.9302 

2 

18 

36 

12.000 

97.4578 

-0.1362 

-0.2492 

3.9301 

2 

19 

38 

12.000 

95.2066 

-0.1497 

-1.4783 

3.9300 

2 

20 

40 

12.000 

93.8084 

-0. 1410 

0.9555 

3.9299 

2 

21 

42 

12.000 

92.4781 

-0. 1330 

0.8666 

3.9297 

2 

22 

44 

12.000 

90.7845 

-0.1352 

-0.2328 

3.9296 

2 

23 

46 

12.00  0 

89.0024 

-0.1387 

-0.3833 

3.9296 

2 

24 

48 

12.000 

87.9807 

-0.1246 

1.5404 

3.9296 

2 

25 

50 

12.000 

85.7274 

-0.1412 

-1.8180 

3.9295 

2 

26 

52 

12.000 

82.8544 

-0.1671 

-2.8246 

3.9295 

2 

27 

54 

12.000 

80.  5045 

-0.1747 

-0.8260 

3  .9295 

2 

28 

56 

12.000 

79.5839 

-0. 1489 

-2.-8182 

3.9295 

2 

29 

58 

12.000 

77.7355 

-0.1502 

-0.1490 

3.9295 

2 

30 

60 

12.000 

75.9437 

-0.1500 

0.0261 

3.9295 
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TARGET    NUMBER 


KLTERED  AND  SMOOTHED 

EMITTER  DATA  CORRELATED  TO  TARGET  NUMBER 

K 

FREO 

PRF 

PW 

THETAD 

THTD 

SLAD 

SLCD 

1 

1197.0 

150.0 

3.50 

106.6854 

106.6854 

33.4991 

-118.5004 

3 

1197.0 

150.0 

3.50 

104.1513 

104.1513 

33.4670 

-118.5002 

5 

1197.0 

150.0 

3.50 

102.4055 

102.3046 

33.4326 

-118.5007 

7 

11 97.0 

150.0 

3.50 

100.3478 

100.2979 

33.4000 

-118.5012 

9 

1197.0 

150.0 

3.50 

99.0287 

98.7523 

33.3669 

-118.5006 

11 

1197.0 

150.0 

3.50 

95.7764 

96.2384 

33.3334 

-118.4993 

13 

1197.0 

150.0 

3.50 

93.3238 

93.7121 

33.3C03 

-118.4999 

15 

1197.0 

150.0 

3.50 

92.9314 

92.1992 

33.2663 

-118.5003 

17 

1197.0 

150.0 

3.50 

87. 5094 

88.9479 

33.2329 

-118.4994 

19 

1197.0 

150.0 

3.50 

87.7487 

87.1063 

33.2001 

-118.4999 

21 

1197.0 

150.0 

3.50 

86. 2396 

85.4691 

33.1664 

-118.5005 

23 

1197.0 

150.0 

3.50 

33.6013 

83.4872 

33. 1337 

-118.4999 

25 

1197.0 

150.0 

3.50 

80.6074 

81  .0923 

33.1003 

-118.5002 

27 

1197.0 

150.0 

3.50 

78.3036 

78.6840 

33.0670 

-118.5003 

29 

1197.0 

150.0 

3.50 

77.1396 

76.7533 

33.0337 

-118.5002 

31 

1197.0 

150.0 

3.50 

75.0945 

74.8173 

33.0003 

-118.5010 

33 

1197.0 

150.0 

3.50 

73.7954 

73.1776 

32.9669 

-118.5000 

35 

1197.0 

150.0 

3.50 

71.6491 

71.3944 

32.9339 

-118.4995 

37 

1197.0 

150.0 

3.50 

67.9644 

68.8458 

32.8998 

-118.4998 

39 

1197.0 

150.0 

3.50 

66.0749 

66.4753 

32. 8670 

-118.5007 

41 

1197.0 

150.0 

3.50 

64.4660 

64.3785 

32.8340 

-118.4997 

43 

1197.0 

150.0 

3.50 

63.9025 

62.9310 

32. 8003 

-118.5001 

45 

1197.0 

150  .0 

3.50 

63.5497 

62.0470 

32. 7663 

-118.5001 

47 

1197.0 

150.0 

3.50 

61.0990 

60.6745 

32.7334 

-118.4997 

49 

1197.0 

150.0 

3.50 

58.8956 

59.0022 

32.6994 

-118.4995 

51 

1197.0 

150  .0 

3.50 

56.0593 

56.8325 

32.6665 

-118.4995 

53 

1197.0 

150.0 

3.50 

55.6143 

55.2973 

32.6332 

-118.5004 

55 

1197.0 

150.0 

3.50 

53.6115 

53.6019 

32.5998 

-118.4998 

57 

1197.0 

150.0 

3.50 

53.2528 

52  .4651 

32.5663 

-118.5007 

59 

1197.0 

150.0 

3.50 

53.0171 

51.7908 

32.5334 

-118.5005 

61 

1197.0 

150.0 

3.50 

50.7876 

50.6026 

32. 5010 

-118.5002 

SMOOTHED    INITIAL    BEARING    ANGLE    =     106.68590    N 
FILTERED    FINAL    BEARING    ANGLE    =       50.60260    W 

-  VECTOR    METHOD    SOLUTION    OF    EMITTER    LOCATION 
EMITTER    LATITUDE    =       33.22765    N 
EMITTER    LONGITUDE    =-117.43607    W 
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TARGET    NUMBER 


FILTERED  AND  SMOOTHED 

EMITTER  DATA  CORRELATED  TO  TARGET  NUMBER 

K 

FREO 

PRF 

PW 

THETAD 

THTD 

SLAD 

SLOD 

2 

1212.0 

250.0 

3.00 

123.1348 

123. 1348 

33.4856 

-118.5002 

4 

1212.0 

250.0 

3.00 

122.4821 

122.4821 

33.4498 

-118.5004 

6 

1212.0 

250.0 

3.00 

120.8329 

120.9605 

33.4160 

-118.5004 

8 

1212.0 

250.0 

3.00 

117.6429 

118.2154 

33.3836 

-118.5015 

10 

1212.0 

250.0 

3.00 

117.0829 

116.7974 

33.3499 

-118.4998 

12 

1212.0 

250.0 

3.00 

116.1623 

115.7090 

33.3168 

-118.4997 

14 

1212.0 

250.0 

3.00 

114.8552 

114.5483 

33.2832 

-118.4999 

16 

1212.0 

250.0 

3.00 

113.2285 

113.1856 

33.2496 

-118.4999 

18 

1212.0 

250.0 

3.00 

111.5610 

111.6861 

33.2163 

-118.4996 

20 

1212.0 

250.0 

3.00 

109.4732 

109.9158 

33. 1830 

-118.5004 

22 

1212.0 

250.0 

3.00 

109.0516 

108.6817 

33.1502 

-118.5002 

24 

1212.0 

250.0 

3.00 

107.9706 

107.5498 

33.1168 

-118.5001 

26 

1212.0 

250.0 

3.0  0 

105.6203 

105.9513 

3  3.0837 

-118.5005 

28 

1212. 0 

250.0 

3.00 

104.2317 

104.4048 

33.0503 

-118.5001 

30 

1212.0 

250.0 

3.00 

102.0015 

102.5540 

33.0171 

-118.5008 

32 

1212.0 

250.0 

3.00 

100.2138 

100.6689 

32.9836 

-118.5007 

34 

1212.0 

250.0 

3.00 

99.3712 

99.1687 

32.9505 

-118.4994 

36 

1212.0 

250.0 

3.00 

97.3126 

97.4578 

32.9167 

-118.4995 

38 

1212.0 

250  .0 

3.00 

94.3452 

95.2066 

32.8835 

-118.5000 

40 

1212.0 

250.  0 

3.00 

94.3653 

93.8084 

32.8505 

-118.5002 

42 

1212.0 

250.0 

3.00 

92.9832 

92.4781 

32.8174 

-118.4997 

44 

1212.0 

250.0 

3.00 

90.6488 

90.7845 

32.7829 

-118.5002 

46 

1212.0 

250.0 

3.00 

88.7791 

89.0024 

32.7499 

-118.4998 

48 

1212.0 

250.0 

3.00 

88.8786 

87.9807 

32.7166 

-118*4993 

50 

1212.0 

250.0 

3.00 

84.6678 

85=727^ 

32.6828 

-118.4995 

52 

1212.0 

250.3 

3.00 

81.2080 

82.8544 

32.6499 

-118.4999 

54 

1212.0 

250.0 

3.00 

80.0231 

80.5045 

32.6162 

-118.5000 

56 

1212.0 

250.  0 

3.00 

81.2266 

79.5839 

32.5830 

-118.5002 

58 

1212.0 

250.0 

3.00 

77.6486 

77.7355 

32. 5498 

-118.5007 

60 

1212.0 

250.0 

3.00 

75.9589 

75.9437 

32.5172 

-118.5006 

SMOOTHED    INITIAL    BEARING    ANGLE    =     123.13492    N 
FILTERED    FINAL    BEARING    ANGLE    =s       75.94370    W 

VECTOR    METHOD    SOLUTION    OF    EMITTER    LOCATION 
EMITTER    LATITUDE    =       32.77921    N 
EMITTER    LONGITUDE    =-117.22505    W 
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PLOT  OF  ERROR  G0URRIRNCE3  OF  SMOOTHED  BERRING  LINE5 


^ 


* 1 — ( 1 1 1 — i — i 1 — i — i 1 — i — i 1- — | — ■+- — t^-t — h — ^ — i 1 — i — ^ — +- 


Figure  12. a.   Angle  Filter  Error  Ellipse  Associated  with 
Lines-of-Bearing  on  Emitter  1. 
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PLOT  OF  ERROR  COURRIRNCES  OF  SMOOTHED  BERRIHG  LINES 
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Figure    12. b 
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Figure    12. c 
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Figure    12 . f 
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PlOT  OF  ERROR  CGUARIRNGES  QF  SMOOTHED  BEARING  LINES 


(VI 


o 
o 


m 

n 


-f 1 H 


H 1 1- 


Figure  12. g 
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Figure  12. h 
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Figure  12 . j 
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Figure  13. a.   Angle  Filter  Error  Ellipse  Associated  with 
Lines-of-Bearing  on  Fmitter  2. 
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Figure    13. d 
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Figure    13. g 
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NAVIGATION  DATA  FILTER  PARAMETERS 


SGI 


SG2 


SP11 


SP12 


SP22 


1 

0.0 

0. 

0 

1.00000 

0.0 

1.00000 

0.0 

2 

0.99999 

0. 

16216 

37.00000 

6.00000 

1.00004 

6.00 

3 

0.99957 

0. 

16646 

0.97585 

0.16251 

0.02711 

6.00 

4 

0.89002 

0. 

11174 

0.00337 

0.00042 

0.00009 

6.00 

5 

0.86395 

0. 

10864 

0.00265 

0.00033 

0.00008 

6.00 

6 

0.86253 

0. 

10906 

0.00261 

0.00033 

0.00008 

6.00 

7 

0.86251 

0. 

10903 

0.00261 

0.00033 

0.00008 

6.00 

8 

0.86246 

0. 

10901 

0.00261 

0.00033 

0.00008 

6.00 

9 

0.86246 

0. 

10901 

0.00261 

0.00033 

0.00008 

6.00 

10 

0.86246 

0. 

10901 

0.00261 

0.00033 

0.00008 

6.00 

11 

0.86246 

0. 

10901 

0.00261 

0.00033 

0.00008 

6.00 

12 

0.86246 

0. 

10901 

0.00261 

0.00033 

0.00008 

6.00 

13 

0.86246 

0. 

10901 

0.00261 

0.00033 

0.00008 

6.00 

14 

0.86246 

0. 

10901 

0.00261 

0.00033 

0.00008 

6.00 

15 

0.86246 

0. 

10901 

0.00261 

0.00033 

0.00008 

6.00 

16 

0.86246 

0. 

10901 

0.00261 

0.00033 

0.00003 

6.00 

17 

0.86246 

0. 

10901 

0.00261 

0.00033 

0.00008 

6.00 

18 

0.86246 

0. 

10901 

0.00261 

0.00033 

0.00008 

6.00 

19 

0.86246 

0. 

10901 

0.00261 

0.00033 

0.00008 

6.00 

20 

0.86246 

0. 

10901 

0.00261 

0.00033 

0.00008 

6.00 

21 

0.86246 

0. 

10901 

0.00261 

0.00033 

0.00003 

6.00 

22 

0.86246 

0. 

10901 

0.00261 

0.00033 

0.00008 

6.00 

23 

0.86246 

0. 

10901 

0.00261 

0.00033 

0.00008 

6.00 

24 

0.86246 

0. 

10901 

0.00261 

0.00033 

0.00008 

6.00 

25 

0.86246 

0. 

10901 

0.00261 

0.00033 

0.00008 

6.00 

26 

0.86246 

0. 

10901 

0.00261 

0.00033 

0.00008 

6.00 

27 

0.86246 

0. 

10901 

0.00261 

0.00033 

0.00008 

6.00 

28 

0.86246 

0. 

10901 

0.00261 

0.00033 

0.00003 

6.00 

29 

0.86246 

0. 

10901 

0.00261 

0.00033 

0.00008 

6.00 

30 

0.86246 

0. 

10901 

0.00261 

0.00033 

0.00008 

6.00 

31 

0.86246 

0. 

10901 

0.00261 

0.00033 

0.00008 

6.00 

32 

0.86246 

0. 

10901 

0.00261 

0.00033 

0.00008 

6.00 

33 

0.86246 

0. 

10901 

0.00261 

0.00033 

0.00008 

6.00 

34 

0.86246 

0. 

10901 

0.00261 

0.00033 

0.00008 

6.00 

35 

0.86246 

0. 

10901 

0.00261 

0.00033 

0.00008 

6.00 

36 

0.86246 

0. 

10901 

0.00261 

0.00033 

0.00008 

6.00 

37 

0.86246 

0. 

10901 

0.00261 

0.00033 

0.00008 

6.00 

38 

0.86246 

0. 

10901 

0.00261 

0.00033 

0.00008 

6.00 

39 

0.86246 

0. 

10901 

0.00261 

0.00033 

0.00008 

6.00 

40 

0.86246 

0. 

10901 

0.00261 

0.00033 

0.00008 

6.00 

41 

0.86246 

0. 

10901 

0.00261 

0.00033 

0.00008 

6.00 

42 

0.86246 

0. 

10901 

0.00261 

0.00033 

0.00008 

6.00 

43 

0.86246 

0. 

10901 

0.00261 

0.00033 

0. 00008 

6.00 

44 

0.86246 

0. 

10901 

0.00261 

0.00033 

0.00008 

6.  00 

45 

0.86246 

0. 

10901 

0.00261 

0.00033 

0.00003 

6.00 

46 

0.86246 

0. 

10901 

0.00261 

0.00033 

0.00008 

6.00 

47 

0.86246 

0. 

10901 

0.00261 

0.00033 

0.00008 

6.00 

48 

0.86246 

0. 

10901 

0.00261 

0.00033 

0.00008 

6.00 

49 

0.86246 

0. 

10901 

0.00261 

0.00033 

0.00008 

6.00 

50 

0.86246 

0. 

10901 

0.00261 

0.00033 

0.00008 

6.00 

51 

0.86246 

0. 

10901 

0.00261 

0.00033 

0.00008 

6.00 

52 

0.86246 

0. 

10901 

0.00261 

0.00033 

0.00008 

6.00 

53 

0.86246 

0. 

10901 

0.00261 

0.00033 

0.00008 

6.00 

54 

0.86246 

0. 

10901 

0.00261 

0.00033 

0.00008 

6.00 

55 

0.86246 

0. 

10901 

0.00261 

0.00033 

0.00008 

6.00 

56 

0.86246 

0. 

10901 

0.00261 

0.00033 

0.00008 

6.00 

57 

0.86246 

0. 

10901 

0.00261 

0.00033 

0.00008 

6.00 

58 

0.86246 

0. 

10901 

0.00261 

0.00033 

0.00008 

6.00 

59 

0.86246 

0. 

10901 

0.00261 

0.00033 

0.00008 

6.00 

60 

0.86246 

0. 

,10901 

0.00261 

0.00033 

0.00008 

6.  00 

61 

0.86246 

0. 

10901 

0.00261 

0.00033 

0.00008 

6.00 
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NAVIGATION  DATA  FILTER  PARAMETERS 


VELND 


ELAT 


SLATD 


VELED 


ELON 


SLOND 


1 

-0. 

.00225 

0, 

.0 

33, 

.49908 

0. 

,00003 

0. 

.0 

-118. 

,50040 

2 

-0, 

.00225 

0, 

.0 

33, 

.48558 

0, 

.00003 

0, 

.00003 

-118, 

50020 

3 

-0. 

.00316 

-0, 

.00546 

33. 

,47208 

-0. 

.00001 

-0, 

.00023 

-118. 

,49998 

4 

-0, 

.00290 

0, 

.00235 

33, 

.44765 

0. 

.00000 

0, 

.00011 

-118. 

50024 

5 

-0. 

.00282 

0, 

.00075 

33, 

.43234 

-0, 

.00012 

-0, 

.00132 

-118. 

50011 

6 

-0. 

.00288 

-0. 

.00063 

33. 

.41608 

0. 

,00012 

0. 

.00239 

-118. 

50192 

7 

-0. 

.00273 

o, 

.00140 

33. 

.39821 

-0, 

,00010 

-0, 

.00224 

-118. 

49911 

8 

-0. 

,00256 

0. 

.00162 

33. 

,38303 

-0. 

,00016 

-0, 

.00080 

-118. 

,50165 

9 

-0. 

.00284 

-0, 

.00266 

33. 

.36908 

0. 

,00015 

0. 

,00310 

-118, 

50328 

10 

-0, 

.00279 

0, 

.00052 

33, 

.34970 

0. 

.00010 

-0, 

.00029 

-118. 

49971 

11 

-0. 

.00284 

-0. 

.00050 

33. 

,33340 

0. 

,00014 

0, 

.00061 

-118. 

,49936 

12 

-0. 

.00270 

0. 

.00134 

33. 

.31590 

-0. 

,00008 

-0. 

.00213 

-118. 

49799 

13 

-0, 

,00279 

-0. 

,00089 

33. 

.30086 

-0. 

.00005 

0, 

.00014 

-118. 

50029 

14 

-0. 

,00273 

0. 

,00055 

33. 

,28333 

0. 

,00006 

0. 

,00114 

-118. 

50047 

15 

-0. 

,00291 

-0, 

.00160 

33. 

.26740 

-0. 

,00012 

-0, 

,00185 

-118. 

49911 

16 

-0. 

,00278 

0. 

.00113 

33. 

,24855 

0. 

.00003 

0, 

,00139 

-118. 

50140 

17 

-0. 

,00275 

0. 

.00032 

33. 

23280 

0. 

,00014 

0. 

,00130 

-118. 

50003 

18 

-0. 

,00278 

-0. 

.00029 

33. 

,21657 

-0. 

,00006 

-0, 

,00195 

-118. 

49805 

19 

-0. 

,00281 

-0. 

,00031 

33. 

.19962 

-0. 

,00001 

0, 

.00046 

-118. 

,50008 

20 

-0. 

.00256 

0. 

.00233 

33. 

,  18245 

-0. 

,00010 

-0. 

,00103 

-118. 

49973 

21 

-0. 

,00298 

-0. 

.00383 

33. 

,16908 

-0. 

,00002 

0. 

.00068 

-118. 

50121 

22 

-0. 

,00276 

0. 

.00197 

33. 

14790 

0, 

,00001 

0, 

.00036 

-118. 

,50075 

23 

-0. 

,00260 

0. 

.00153 

33. 

,13301 

0. 

,00009 

0. 

.00082 

-118. 

50034 

24 

-0. 

,00277 

-0. 

,00163 

33. 

.11874 

-0. 

.00004 

-0, 

.00128 

-118. 

49910 

25 

-0. 

,00294 

-0. 

,00154 

33. 

,  10068 

0. 

,00001 

0. 

,00049 

-118. 

50046 

26 

-0. 

,00262 

0, 

.00294 

33. 

,08167 

-0. 

,00008 

-0. 

,00093 

-118. 

49998 

27 

-0. 

,00280 

-0. 

,00165 

33. 

.06847 

0. 

,00002 

0. 

.00095 

-118. 

,  50125 

28 

-0. 

,00278 

0. 

,00017 

33. 

,05022 

0. 

,00004 

0. 

,00031 

-118. 

50031 

29 

-0. 

,00280 

-0. 

.00018 

33. 

,03365 

0. 

,00003 

-0, 

.00012 

-118. 

49976 

30 

-0. 

,00274 

0. 

,00058 

33. 

,01665 

-0. 

,00011 

-0, 

.00142 

-118, 

,49968 

31 

-0. 

,00275 

-0. 

,00006 

33. 

,00069 

-0. 

,00005 

0. 

.00049 

-118. 

50154 

32 

-0. 

,00282 

-0. 

.00072 

32. 

.98415 

0. 

.00000 

0, 

.00044 

-118. 

,50137 

33 

-0. 

,00279 

0. 

,00035 

32. 

,96657 

0. 

,00008 

0. 

,00088 

-118. 

50098 

34 

-0. 

.00277 

0. 

.00015 

32. 

,95013 

0. 

,00014 

0. 

,00074 

-118. 

49971 

35 

-0. 

,00274 

0. 

,00024 

32. 

.93364 

-0. 

.00002 

-0. 

.00152 

-118. 

,49825 

36 

-0. 

,00272 

0. 

.00024 

32. 

.91737 

0. 

00001 

0. 

,00033 

-118. 

49969 

37 

-0. 

,00295 

-0. 

.00212 

32. 

,90126 

-0. 

,00005 

-0. 

.00065 

-118. 

49934 

38 

-0. 

,00280 

0. 

,00133 

32. 

,83174 

0. 

,00002 

0, 

.00073 

-118. 

,50020 

39 

-0. 

.00260 

0. 

,00186 

32. 

,86606 

-0. 

,00018 

-0, 

,00223 

-118. 

49940 

40 

-0. 

,00280 

-0. 

,00186 

32. 

,85205 

0. 

,00008 

0, 

.00256 

-118. 

50243 

41 

-0. 

,00277 

0. 

,00031 

32. 

83360 

0. 

,00007 

0. 

,00003 

-118. 

49973 

42 

-0. 

,00274 

0. 

.00024 

32. 

,81725 

0. 

,00005 

-0, 

.00012 

-118. 

49927 

43 

-0. 

00277 

-0. 

,00027 

32. 

,80098 

-0. 

,00008 

-0, 

.00135 

-118, 

,49907 

44 

-0. 

.00285 

-0. 

,00067 

32. 

,78409 

-0. 

,00002 

0. 

,00058 

-118. 

50072 

45 

-0. 

,00299 

-0, 

.00130 

32. 

,76642 

-0, 

,00000 

0, 

.00014 

-118. 

50031 

46 

-0. 

,00265 

0. 

,00305 

32. 

,74736 

0. 

,00005 

0, 

.00051 

-118. 

,50018 

47 

-0. 

,00270 

-0. 

.00040 

32. 

,73405 

-0. 

,00002 

-0, 

.00063 

-118. 

49947 

48 

-0. 

,00282 

-0. 

,00116 

32. 

.71751 

0. 

,00011 

0, 

.00141 

-118. 

,50011 

49 

-0. 

.00277 

0. 

,00047 

32. 

,69955 

-0. 

,00007 

-0. 

,00178 

-118. 

49820 

50 

-0. 

,00290 

-0, 

.00119 

32. 

,68330 

-0. 

,00000 

0, 

.00059 

-118. 

50012 

51 

-0. 

,00271 

0. 

.00172 

32. 

.66484 

0. 

.00004 

0. 

.00044 

-118. 

,49962 

52 

-0. 

,00266 

0. 

.00050 

32. 

.65002 

-0. 

,00003 

-0. 

.00071 

-118. 

49901 

53 

-0. 

,00287 

-0, 

.00189 

32. 

,63449 

-0. 

,00016 

-0. 

.00139 

-118. 

49980 

54 

-0. 

.00270 

0. 

.00150 

32. 

,61566 

0. 

,00008 

0, 

.00233 

-118. 

,50192 

55 

-0. 

,00295 

-0. 

.00229 

32. 

,60072 

0. 

00005 

-0. 

,00023 

-118. 

49940 

56 

-0. 

,00260 

0. 

.00323 

32, 

.58102 

-0. 

.00003 

-0, 

.00081 

-118. 

,49931 

57 

-0. 

,00283 

-0. 

.00212 

32. 

,56819 

-0. 

,00011 

-0. 

,00089 

-118. 

50020 

58 

-0. 

,00285 

-0. 

.00015 

32. 

,54936 

-0. 

,00001 

0, 

.00090 

-118. 

50162 

59 

-0. 

,00263 

0. 

,00200 

32. 

.53214 

0. 

.00006 

0, 

.00075 

-118. 

,50089 

60 

-0. 

,00278 

-0. 

.00134 

32. 

.51805 

-0. 

,00007 

-0. 

,00127 

-118, 

49986 

61 

-0. 

.00268 

0, 

.00092 

32. 

,50023 

0. 

,00007 

0, 

.00133 

-118. 

50134 
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KALMAN  FILTER  PARAMETERS  FOR  ANGLE  FILTER 


I 

J 

K 

Pll(K) 

P12(K) 

G1IKI 

G2(K) 

1 

0 

1 

10000.0000 

0.0 

0.9999 

0.0 

1 

2 

3 

1440001.0000 

120000.0000 

1.0000 

0.0833 

1 

3 

5 

6.8125 

0.3202 

0.8720 

0.0410 

1 

4 

7 

2.7990 

0.1196 

0.7368 

0.0315 

2 

0 

2 

10000.0000 

0.0 

0.9999 

0.0 

2 

2 

4 

1440001 .0000 

120000.0000 

1.0000 

0.0833 

2 

3 

6 

6.8125 

0.3202 

0.8720 

0.0410 

2 

4 

8 

2.7990 

0. 1196 

0.7368 

0.0315 
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KALMAN  FILTER  PARAMETERS  FOR  ANGLE  FILTER 


I 

J 

K 

T(K1 

THTD(K) 

TDTD(K) 

1 

0 

1 

0.0 

106.6854 

0.0930 

1 

2 

3 

12.000 

104.1513 

-0. 2112 

1 

3 

5 

12.000 

102.3046 

-0. 1789 

1 

4 

7 

12,000 

100.2979 

-0. 1729 

2 

0 

2 

0.0 

123.1348 

0.0810 

2 

2 

4 

12.000 

122.4821 

-0.0544 

2 

3 

6 

12.000 

120.9605 

-0.0952 

2 

4 

8 

12.000 

118.2154 

-0.1637 

E(K) 


GATE(K) 


•3.6504  3600.0022 

0.7882  8.3853 

0.1896  5.8473 

■1.6245  3600.0022 

•0.9966  8.3853 

■2.1748  5.8473 
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THE    EXTENDED    KALMAN    FILTER    IS    INITIATED    WITH    THE 
FOLLOWING    ELLIPSE    FOR    CUT    NUMBER       4    OF    TARGET       1 


THE    ANGLE    BETWEEN    THE    MAJGR    AXIS    AND    THE    MERIDIAN 
THROUGH    THE    CENTER    OF    THE    ELLIPSE    IS    104.941     DEGREES 


THE    LENGTH    OF    THE    SEMI-MAJOR    AXIS     IS 
THE    LENGTH   OF    THE    SEMI-MINOR    AXIS    IS 


0.255    DEGREES, 
0.019    DEGREES, 
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EXTENDED    KALMAN    FILTER    PARAMETERS 


Pll 


P12 


P22 


GX 


GY 


7 

0.607E-01 

-0.161E- 

-01 

0.466E- 

-02 

0.112 

-0.038 

9 

0.600E-01 

-0.159E- 

-01 

0.463E- 

-02 

0.162 

-0.052 

11 

0.587E-01 

-0.154E- 

-01 

0.452E- 

-02 

0.213 

-0.066 

13 

0.563E-01 

-0.147E- 

-01 

0.433E- 

-02 

0.247 

-0.075 

15 

0.530E-01 

-0.137E- 

-01 

0.407E- 

-02 

0.271 

-0.081 

17 

0.490E-01 

-0.125E- 

-01 

0.374E- 

-02 

0.283 

-0.084 

19 

0.445E-01 

-0.112E- 

-01 

0.338E- 

-02 

0.282 

-0.083 

21 

0.400E-01 

-0.984F- 

-02 

0.303E- 

-02 

0.278 

-0.081 

23 

0.355E-01 

-0.854E- 

-02 

0.268E- 

-02 

0.265 

-0.077 

25 

0.315E-01 

-0.736E- 

-02 

0.237E- 

-02 

0.250 

-0.073 

27 

0.279E-01 

-0.631E- 

-02 

0.211E- 

-02 

0.233 

-0.068 

29 

0.248E-01 

-0.541E- 

-0  2 

0.188E- 

-02 

0.217 

-0.063 

31 

0.221E-01 

-0.462E- 

-02 

0.169E- 

-02 

0.201 

-0.058 

33 

0.197E-01 

-0.396E- 

-02 

0.153E- 

-02 

0.  186 

-0.054 

35 

0.178E-01 

-0.339E- 

-02 

0.141E- 

-02 

0.172 

-0.050 

37 

0.161E-01 

-0.291E- 

-02 

0.130E- 

-02 

0.159 

-0.046 

39 

0.147E-01 

-0.250E- 

-02 

0.122E- 

-02 

0.147 

-0.042 

41 

0.134E-01 

-0.215E- 

-02 

0.116E- 

-02 

0.137 

-0.040 

43 

0.124E-01 

-0.185E- 

-02 

0.111E- 

-02 

0.128 

-0.037 

45 

0.115E-01 

-0.159E- 

-02 

0.107E- 

-02 

0.119 

-0.034 

47 

0.107E-01 

-0.136E- 

-02 

0.  104E- 

-02 

0.112 

-0.032 

49 

0.100E-01 

-0.116E- 

-02 

0.102E- 

-02 

0.104 

-0.030 

51 

0.945E-02 

-0.991E- 

-0  3 

0.100E- 

-02 

0.098 

-0.029 

53 

0.893E-02 

-0.840E- 

-03 

0.995E- 

-03 

0.092 

-0.027 

55 

0-848 E-02 

-0.706E- 

-03 

0.992E- 

-03 

0.087 

-0.026 

57 

0.808E-02 

-0.587E- 

-03 

0.Q92E- 

-03 

0.082 

-0.024 

59 

0.772E-02 

-0.480E- 

-03 

0.997E- 

-03 

0.077 

-0.023 

61 

0.740E-02 

-0.384E- 

-03 

0.100E- 

-02 

0.073 

-0.022 

DMX 


DMY 


TX 


ER 


XTD 


YTD 


7 

-0.1794 

-1.0314 

1.7552 

-0.0038 

-117.4961 

33.2432 

9 

-0.1434 

-1.0706 

1.7169 

0.0115 

-117.4918 

33.2473 

11 

-0.1003 

-1.108  2 

1.6731 

-0.0015 

-117.4896 

33.2476 

13 

-0.0614 

-1.1383 

1.6329 

-0.0041 

-117.4890 

33.2481 

15 

-0.0214 

-1.1676 

1.5921 

0.0299 

-117.4888 

33.2486 

17 

0.0184 

-1.1950 

1.5552 

-0.0279 

-117.4849 

33.2477 

19 

0.0551 

-1.2111 

1.5116 

0.0199 

-117.4873 

33.2489 

21 

0.0952 

-1.2323 

1.4762 

0.0289 

-117.4850 

33.2484 

23 

0.1308 

-1.2440 

1  .4402 

0.0189 

-117.4816 

33.2476 

25 

0.1648 

-1.2498 

1.4021 

0.0047 

-117.4790 

33.2469 

27 

0.1974 

-1.2532 

1.3639 

0.0028 

-117.4777 

33.2466 

29 

0.2293 

-1.2548 

1.3271 

0.0192 

-117.4768 

33.2464 

31 

0.2591 

-1.2524 

1.2935 

0.0172 

-117.4747 

33.2457 

33 

0.2868 

-1.2474 

1.2585 

0.0295 

-117.4728 

33.2451 

35 

0.3120 

-1.2394 

1  .2264 

0.0241 

-117.4701 

33.2442 

37 

0.3348 

-1.2271 

1.1930 

-0.0068 

-117.4678 

33.2433 

39 

0.3544 

-1.2130 

1.1593 

-0.0061 

-117.4673 

33.2431 

41 

0.3747 

- 1 . 1 99  5 

1.1279 

-0.0027 

-117.4671 

33.2429 

43 

0.39  28 

-1.1829 

1.0972 

0.0181 

-117.4668 

33.2427 

45 

0.4092 

-1.1646 

1.0686 

0.0406 

-117.4657 

33.2422 

47 

0.42  27 

-1.1455 

1.0422 

0.0241 

-117.4636 

33.2413 

49 

0.4340 

-1.1243 

1.0137 

0.0142 

-117.4621 

33.2407 

51 

0.4436 

-1.1032 

0.9872 

-0.0088 

-117.4610 

33.2401 

53 

0.4516 

-1.0810 

0.9607 

0.0099 

-117.4609 

33.2399 

55 

0.4596 

-1  .0589 

0.9365 

-0.0008 

-117.4602 

33.2395 

57 

0.4651 

-1.0360 

0.9123 

0.0172 

-117.4599 

33.2393 

59 

0.4702 

-1.0137 

0.8903 

0.0351 

-117.4592 

33.2389 

61 

0.4738 

-0,9917 

0.8696 

0.0168 

-117.4580 

33.2383 
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EXTENDED  KALMAN  FILTER  PARAMETERS 


K 

7 
9 
11 
13 
15 
17 
19 
21 
23 
25 
27 
29 
31 
33 
35 
37 
39 
41 
43 
45 
47 
49 
51 
53 
55 
57 
59 
61 


0, 
0, 
0. 
0. 


EP11 

0.607E-01 
0.239E-01 
0.134E  00 
,106E  00 
•  712F-01 
.538E-01 
■450E-01 
0.406E-01 
0.387E-01 
0.381E-01 
0.381E-01 
0.383E-01 
0.384E-01 
0.385E-01 
0.385E-01 
0.385E-01 
0.385F-01 
0.385E-01 
0.385E-01 
0.385E-01 
0.385E-01 
0.385E-01 
0.385E-01 
0.385E-01 
0.385E-01 
0.385E-01 
0.385E-01 
0.385E-01 


EP12 

-0.161E-01 
0.668E-02 
0.151E-01 
0.745E-02 
0.382F-02 
0.249F-02 
0.198E-02 
0.179E-02 
0. 173E-02 
0.  174E-02 
0.176E-02 
0.178E-02 
0.173F-02 
0.179E-02 
0.179E-02 
0.179E-02 
0.179F-02 
0.179F-02 
179E-02 
179E-02 
179E-02 
0.179E-02 
0.179E-02 
0.179E-02 
0.179E-02 
0.179E-02 
0.179E-02 
0.179E-02 


0. 
0, 
0 


EP22 

0.466E-02 

0.236E-02 
0.  179E-02 
0.594E-03 
0.273E-03 
0.189E-03 
0.165E-03 
0.160E-03 
0.161E-03 
0.163E-03 
0.165E-03 
0.166E-03 
0. 166E-03 
0. 166E-03 
0. 166E-03 
166E-03 
165E-03 
165E-03 
165E-03 
165E-03 
165E-03 
0.165E-03 
0.165E-03 
0.165E-03 
0.165E-03 
0. 165E-03 
0.165E-03 
0.165E-03 


0 

0. 

0, 

0 

0, 

0 


Gl 

0.548 
0.323 
0.728 
0.679 
0.587 
0.518 
0.474 
0.448 
0.437 
0.433 
0.433 
0.434 
0.435 
0.435 
0.435 
0.435 
0.435 
0.435 
0.435 
0.435 
0.435 
0.435 
0.435 
0.435 
0.43  5 
0.435 
0.435 
0.435 


G2 

-0.145 

0.090 
0.082 
0.048 
0.031 
0.024 
0.021 
0.020 
0.020 
0.02  0 
0.020 
0.020 
0.020 
0.020 
0.020 
0.020 
0.020 
0.020 
0.020 
0.020 
0.020 
0.020 
0.020 
0.020 
0.020 
0.020 
0.020 
0.020 


K 

7 
9 
11 
13 
15 
17 
19 
21 
23 
25 
27 
29 
31 
33 
35 
37 
39 
41 
43 
45 
47 
49 
51 
53 
55 
57 
59 
61 


EX 

0.0 

-0.0054 

-0.0006 

■0.0019 

•0.0018 

0.0062 

•0.0077 

0.0045 

0.0062 

0.0032 

-0.0001 

-0.0004 

0.0028 

0.0021 

0.0037 

0.0024 

•0.0020 

-0.0015 

-0.0008 

0.0016 

0.0036 

0.0016 

0.0005 

-0.0013 

0.0004 

•0.0004 

0.0009 

0.0020 


EY 

0.0 

-0.0059 

-0.0034 

-0.0011 

-0.0005 

-0.0032 

0.0021 

-0.0022 

-0.0026 

-0.0014 

-0.0002 

0.0000 

-0.0010 

-0.0007 

-0.0012 

-0.0006 

0.0009 

0.0008 

0.0005 

■0.0003 

-0.0010 

-0.0003 

0.0001 

0.0008 

0.0002 

0.0004 

-0.0001 

-0.0004 


XTDDOT 

0.0010 
0.0004 
0.0003 
0.0002 
0.0001 
0  .0002 
0.0000 
0.0001 
0.0002 
0.0002 
0  .0002 
0.0001 
0.0002 
0.0002 
0.0002 
0.0002 
0.0001 
0.0001 
0.0001 
0.0001 
0.0001 
0.0001 
0.0001 
0.0001 
0.0001 
0.0001 
0.0001 
0.0001 


YTDDOT 

0.0010 

0.0005 

0.0002 

0.0001 

0.0001 

0.0000 

0.0001 

0.0000 

-0.0000 

-0.0000 

-0.0000 

-0.0000 

-0.0001 

-0.0001 

-0.0001 

-0.0001 

-0.0001 

-0.0001 

-0.0001 

-0.0001 

-0.0001 

-0.0001 

-0.0001 

-0.0001 

-0.0001 

-0.0001 

-0.0001 

-0.0001 


XTD1 


117, 
■117. 

117. 
•117, 

117. 
•117, 

117. 

117. 
•117, 

117. 

117, 

117. 

117. 

117, 
•117. 

117. 

117, 

117. 

117. 

117. 

117. 

117, 
■117, 

117. 

117, 

117. 

117. 

117. 


4965 
4899 
4899 
4900 
4807 
4928 
4816 
4769 
4765 
4778 
4770 
4726 
4712 
4673 
4659 
4688 
4682 
4674 
4645 
4608 
4609 
4606 
4619 
4599 
4603 
4585 
4565 
4568 


YTD1 

33.2434 
33.2467 
33.2477 
33.2484 
33.2462 
33.2500 
33.2472 
33.2461 
33.2461 
33.2465 
33.2464 
33.2452 
33.2447 
33.2435 
33.2430 
33.2436 
33.2433 
33.2430 
33.2420 
33.2403 
33.2405 
33.2402 
33.2404 
33.2397 
33.2396 
33.2389 
33.2381 
33.2379 
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THE    EXTENDED    KALMAN    FILTER    IS     INITIATED    WITH    THE 
FOLLOWING    ELLIPSE    FOR    CUT    NUMBER      4    OF    TARGET       2 


THE    ANGLE    BETWEEN    THE    MAJOR    AXIS    AND    THE    MERIDIAN 
THROUGH    THE    CENTER    OF    THE    ELLIPSE    IS    122.129    DEGREES, 


THE    LENGTH    OF    THE    SEMI-MAJOR    AXIS     IS 
THE    LENGTH    OF    THE    SEMI-MINOR    AXIS    IS 


0.361    DEGREES, 
0.023    DEGREES, 
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EXTENDED    KALMAN    FILTER    PARAMETERS 


K 


Pll 


P12 


P22 


GX 


GY 


8 

0.934F- 

-01 

-0.583E- 

-01 

0.371E- 

-01 

-0.038 

0.015 

10 

0.933E- 

-01 

-0.583F- 

-01 

0.372E- 

-01 

0.036 

-0.032 

12 

0.932F- 

-01 

-0.582E- 

-01 

0.371E- 

-01 

0.  116 

-0.083 

14 

0.925F- 

-01 

-0.577E- 

-01 

0.368E- 

-01 

0.193 

-0.132 

16 

0.906E- 

-01 

-0.564E- 

-01 

0.360E- 

-01 

0.2  63 

-0.176 

18 

0.870E- 

-01 

-0.540E- 

-01 

0.344E- 

-01 

0.317 

-0.209 

20 

0.816E- 

-01 

-0.504E- 

-01 

0.320E- 

-01 

0.353 

-0.232 

22 

0.747E- 

-01 

-0.459E- 

-01 

0.291E- 

-01 

0.370 

-0.242 

24 

0.669E- 

-01 

-0.408E- 

-01 

0.259E- 

-01 

0.373 

-0.242 

26 

0.589F- 

-01 

-0.356E- 

-01 

0.225E- 

-01 

0.360 

-0.233 

28 

0.513E- 

-01 

-0.307E- 

-01 

0.194E- 

-01 

0.340 

-0.219 

30 

0..445E- 

-01 

-0.263E- 

-01 

0.166E- 

-01 

0.318 

-0.204 

32 

0.386F- 

-01 

-0.225E- 

-01 

0.  142E- 

-01 

0.294 

-0.189 

34 

0.335E- 

-0  1 

-0.193F- 

-01 

0.121E- 

-01 

0.272 

-0.174 

36 

0.292F- 

-01 

-0.165E- 

-01 

0.104E- 

-01 

0.250 

-0.160 

38 

0.256F- 

-01 

-0.142E- 

-01 

0.894F- 

-02 

0.230 

-0.146 

40 

0.225E- 

-01 

-0.122E- 

-01 

0.774E- 

-02 

0.211 

-0.134 

42 

0.199F- 

-01 

-0.  106E- 

-01 

0.673E- 

-02 

0.195 

-0.124 

44 

0.177E- 

-01 

-0.921E- 

-02 

0.589E- 

-02 

0.  180 

-0.114 

46 

0.159F- 

-01 

-0.804E- 

-02 

0.518E- 

-02 

0.166 

-0.105 

48 

0.143E- 

-01 

-0.705F- 

-02 

0.459E- 

-02 

0.154 

-0.097 

50 

0.130E- 

-01 

-0.620E- 

-02 

0.410E- 

-02 

0.143 

-0.090 

52 

0.118E- 

-01 

-0.548E- 

-02 

0.368E- 

-02 

0.132 

-0.083 

54 

0.109E- 

-01 

-0.486E- 

-02 

0.332E- 

-02 

0.124 

-0.078 

56 

0.100E- 

-01 

-0.432E- 

-02 

0.302E- 

-02 

0.116 

-0.073 

58 

0.925F- 

-02 

-0.386F- 

-02 

0-276E- 

-02 

0.109 

-0.068 

60 

0.860E- 

-02 

-0.344E- 

-02 

0.254E- 

-02 

0.102 

-0.064 

K 


DMX 


DMY 


TX 


ER 


XTD 


YTD 


8 

-0.3977 

-0.6036 

2.0672 

-0.0139 

-117.4485 

32.9048 

10 

-0.3825 

-0.6431 

2.0379 

0.0056 

-117.4464 

32.9055 

12 

-0.3630 

-0.6822 

2.0063 

0.0211 

-117.4460 

32.9052 

14 

-0.3428 

-0.7220 

1.9754 

0.0292 

-117.4444 

32.9038 

16 

-0.3208 

-0.7603 

1.9448 

0.0314 

-117.4413 

32.9012 

18 

-0.2977 

-0.7959 

1.9146 

0.0325 

-117.4371 

32.8977 

20 

-0.2727 

-0.8287 

1.8842 

0.0265 

-117.4321 

32.8935 

22 

-0.2477 

-0.8.59  5 

1.8535 

0.0498 

-117.4273 

32.8894 

24 

-0.2212 

-0.8901 

1.8263 

0.0581 

-117.4191 

32.8825 

26 

-0.1952 

-0.9131 

1.7991 

0.0444 

-117.4091 

32.8741 

28 

-0.1699 

-0.9326 

1.7687 

0.0505 

-117.4005 

32.8667 

30 

-0.1441 

-0.9517 

1.7412 

0.0391 

-117.3913 

32.8586 

32 

-0.1187 

-0.9690 

1.7109 

0.0381 

-117.3836 

32.8515 

34 

-0.0936 

-0.9876 

1.6825 

0.0519 

-117.3765 

32.8446 

36 

-0.0677 

-1.0046 

1.6555 

0.0429 

-117.3684 

32.8369 

38 

-0.0433 

-1.0175 

1.6265 

0.0201 

-117.3615 

32.8299 

40 

-0.  0189 

-1.0307 

1.5953 

0.0517 

-117.3570 

32.8247 

42 

0.0066 

-1.0461 

1.5705 

0.0524 

-117.3506 

32.8180 

44 

0.0315 

-1  .057  1 

1.5415 

0.0407 

-117.3445 

32.8115 

46 

0.0546 

-1.0664 

1.5126 

0.0369 

-117.3394 

32.8058 

48 

0.0782 

-1.0757 

1.4840 

0.0673 

-117.3350 

32.8005 

50 

0.1018 

-1.0834 

1.4587 

0.0190 

-117.3292 

32.7943 

52 

0.1227 

-1.0873 

1.4272 

-0.0098 

-117.3262 

32.7901 

54 

0.1456 

-1.0930 

1.3954 

0.0013 

-117.3250 

32.7873 

56 

0.1687 

-1.0984 

1.3671 

0.0506 

-117.3237 

32.7845 

58 

0.1908 

-1.1013 

1.3425 

0.0127 

-117.3206 

32.7805 

60 

0.2102 

-1.1013 

1.3124 

0.0133 

-117.3191 

32.7778 
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EXTENDED  KALMAN  FILTER  PARAMETERS 


K 


EP11 


EP12 


EP22 


8   0.934E-01  -0.583E-01   0.371E-01 


10  0.272E  00 

12  0.234E  00 

14  0.105E  00 

16  0.665E-01 

18  0.505E-01 

20  0.429c-01 

22  0.394E-01 

24  0.381E-01 

26  0.379E-01 

28  0.380E-01 

30  0.383E-01 

32  0.384E-01 

34  0.385E-01 

36  0.386E-01 

38  0.385E-01 

40  0.385E-01 

42  0.385E-01 

44  0.385E-01 

46  0.385E-01 

48  0.385E-01 

50  0.385E-01 

52  0.385E-01 

54  0.385E-01 

56  0.385E-01 

58  0.385E-01 

60  0.385E-01 


0.602E-01 
0.225E-01 
0.662E-02 
0.330E-02 
0.224E-02 
0.185E-02 
0.173E-02 
0.171E-02 
0.174E-02 
0.176E-02 
0.  178E-02 
0.  179E-02 
0.179E-02 
0.179E-02 
0.  179E-02 
0.179E-02 
0.179E-02 
0.179E-02 
0.178E-02 
0.179E-02 
0.179E-02 
0.179E-02 
0.179E-02 
0. 179E-02 
0.179E-02 
0.179E-02 


0. 135E-01 
0.223E-02 
0.477E-03 
0.230E-03 
0.172E-03 
0.159E-03 
0.  158E-03 
0.160E-03 
0. 163E-03 
0. 165E-03 
0.166E-03 
0.166E-03 
0.166E-03 
0.166E-03 
0. 166E-03 
0.165E-03 
0.165E-03 
0.165E-03 
0.165E-03 
0.165E-03 
0.165E-03 
0. 165E-03 
0.165E-03 
0. 165E-03 
0. 165E-03 
0.165E-03 


Gl 

0.651 

0.845 
0.824 
0.677 
0.571 
0.502 
0.462 
0.441 
0.432 
0.431 
0.432 
0.434 
0.435 
0.435 
0.435 
0.435 
0.435 
0.435 
0.435 
0.435 
0.435 
0.435 
0.435 
0.435 
0.435 
0.435 
0.435 


G2 

■0.407 
0.187 
0.079 
0.043 
0.028 
0.022 
0.020 
0.019 
0.019 
0.02  0 
0.020 
0.020 
0.02  0 
0.020 
0.020 
0.020 
0.020 
0.020 
0.020 
0.020 
0.020 
0.020 
0.020 
0.020 
0.020 
0.020 
0.020 


K  EX 

8  0.0 

10  -0.0046 

12  -0.00  04 
14  0.0017 
16  0.0041 

18  0.0059 

20  0.0072 
22  0.0061 

24  0.0135 
26  0.0154 
28  0.0098 

30  0.0105 

32  0.0063 

34  0.0054 
36  0.0080 

38  0.0051 

40  0.0002 

42  0.0060 
44  0.0054 

46  0.0030 

48  0.0023 

50  0.0061 

52  -0.0004 

54  -0.0033 

56  -0.0015 
58  0.0037 

60  -0.0002 


EY 

0.0 

-0.0052 

0.0008 

-0.0012 

-0.0030 

-0.0041 

-0.0049 

-0.0036 

-0.0091 

-0.0101 

-0.0051 

-0.0053 

-0.0015 

-0.0006 

-0.0023 

0.0001 

0.0040 

-0.0005 

0.0001 

0.0019 

0.0024 

-0.0005 

0.0044 

0.0064 

0.0047 

0.0005 

0.0033 


XTDDOT 

0.0010 
0.0001 
0.0001 
0.0001 
0.0002 
0.0003 
0.0004 
0.0004 
0.0006 
0.0007 
0.0008 
0.0008 
0.0008 
0.0008 
0.0008 
0.0007 
0.0006 
0.0006 
0.0006 
0.0006 
0.0005 
0.0005 
0.0004 
0.0003 
0.0002 
0.0003 
0.0002 


YTDDOT 

0.0010 
-0.0002 
-0.0001 
-0.0001 
-0.0002 
-0.0003 
-0.0004 
-0.0005 
-0.0007 
-0.0009 
-0.0010 
-0.0011 
-0.0011 
-0.0011 
-0.0012 
-0.0012 
-0.0011 
-0.0011 
-0.0011 
-0.0011 
-0.0010 
-0.0010 
-0.0009 
-0.0008 
-0.0007 
-0.0007 
-0.0006 


XTD1 

■117.4480 
■117.4462 
•117.4436 
•117.4388 

117.4331 
•117.4268 
•117.4228 
■117.4089 
■117.3974 
■117.3931 
•117.3834 
•117.3789 
•117.3724 
■117.3624 
■117.3577 
•117.3569 

117.3461 
■117.34C4 
■117.3372 
•117.3333 

117.3247 
■117.3265 

117.3275 
■117  .3248 
•117.3178 
•117.3192 
■117.3177 


YTD1 

32.9046 
32.9053 
32.9034 
32.8999 
32.8957 
32  .8909 
32.8  874 
32.8773 
32.8684 
32.8638 
32.8556 
32.8506 
32.8443 
32.8356 
32.8300 
32.8270 
32.8177 
32.8115 
32.8068 
32.8019 
32.7940 
32.7926 
32.7909 
32.7872 
32.7809 
32.7797 
32.7770 
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TARGET    NUMBER       1 
FILTERED    AND    SMOOTHED    EMITTER    DATA    CORRELATED    TO    TARGET    NUMBER       1 

K       FRED         PRF         PW  THETAD  THTD  SLAD  SLOD 

1    1197.0    150.0  3.50  106.6854  106.6854  33.4991  -118.5004 

3    1197.0    150.0  3.50  104.1513  104.1513  33.4670  -118.5002 

5    1197.0    150.0  3.50  102.4055  102.3046  33.4326  -118.5007 

7    1197.0    150.0.  3.50  100.3478  100.2979  33.4000  -118.5012 

SMOOTHED    INITIAL    BEARING    ANGLE    =    106.68600    N 
FILTERED    FINAL    BEARING    ANGLE    =    100.29791    W 

VECTOR    METHOD    SOLUTION    OF    EMITTER    LOCATION 
EMITTER    LATITUDE    =       33.24323    N 
EMITTER    LONGITUDE    =-117.49606    W 

EXTENDED    KALMAN    FILTER    SOLUTION    OF    EMITTER    LOCATION 
EMITTER    LATITUDE    =       33.23833    N 
EMITTER    LONGITUDE    =-117.45799    W 
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TARGET    NUMBER       2 
FILTERED    AND    SMOOTHED    EMITTER    DATA    CORRELATED    TO    TARGET    NUMBER 

K       FREO         PRF  PW  THETAD  THTD  SLAD  SLOD 

2    1212-0    250.0    3-00  123.1348  123.1348  33.4856   -118.5002 

4    1212.0    250.0    3.00  122.4821  122.4821  33.4498    -118.5004 

6    1212.0    250.0    3.00  120.8329  120.9605  33.4160    -118.5004 

8    1212.0    250.0   3.00  117.6429  118.2154  33.3836   -118.5015 

SMOOTHED    INITIAL    BEARING    ANGLE    =     123.13493    N 
FILTERED    FINAL    BEARING    ANGLE    =    118.21536    W 

VECTOR    METHOD    SOLUTION    OF    EMITTER    LOCATION 
EMITTER    LATITUDE    =       32.90477    N 
EMITTER    LONGITUDE    =-117.44853    W 

EXTENDED    KALMAM    FILTER    SOLUTION    OF    EMITTER    LOCATION 
EMITTER    LATITUDE    =       32.77782    N 
EMITTER    LONGITUDE    =-117.31906    W 
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PLOT  OF  ERROR  C0U.RRIRNCES  OF  EXTENDED  KRLtfflN  FILTER 


w 


_J 1 1 L- 


Figure  14. a.   Extended  Kalman  Filter  Error  Ellipse 
Associated  with  Lines-of-Bearing  on 
Emitter  1. 
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PLOT  OF  ERROR  CQURRIRNCES  OF  EKTENDED  KRLMRN  FILTER 
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PLOT  OF  ERROR  C3URRjnNCE3  OF  EXTENDED  KRLMRN  FILTER 
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Figure    14. c 
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PLOT   OF  t-RRQR   COURR1RHCES   OF  FUNDED   KRLMRM  FILTER 
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PLOT  OF  ERROR  CQUflRIRNCES  OF  EXTENDED  KRLMRN  FILTER 
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Figure    14. e 
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PLOT   OF  ERROR   COURRIRNCES   OF  EMENDED   KRLK1RN  FILTER 
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PLOT  OF  ERROR  COURRIRNCES  3F  EXTENDED  KRLMRN  FILTER 
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Figure  14. g 
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PLOT  OF  ERROR   0GURRIRNCE3   OF  EXTENDED  KRLMRH  FILTER 
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Figure    14. h 
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PLOT  GF  ERROR  C3URRIRNCES  3F  EXTENDED  KRLMRN  FILTER 
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Figure    14. i 
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PLOT   OF   ERROR   CDURR1RHCES   OF  EXTENDED  KRLK1RN  FILTER 
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PLOT  GF  ERROR  CQURRJRNCES  OF  EXTENDED  KRLMRN  FILTER 
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Figure    14. k 
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PLOT  OF  ERROR  CQURRIRNCES  OF  EXTENDED  KRLtiRN  FILTER 
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Figure  15. a.  '  Extended  Kalman  Filter  Frror  Ellipse 
Associated  with  Lines-of-Bearing  on 
Emitter  2 . 
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PLGT    OF    ERROR    CGURRJRNCES   OF   EXTENDED   KRLKIRH   FILTER 
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Figure    15. b 
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PLOT  OF  ERROR  COURRIRNCES  OF  EXTENDED  KRLMRN  FILTER 
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PLOT  OF  ERROR  CQURRJRNCt'S  OF  EXTENDED  KRLMRH  FILTER 
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PLOT  OF  ERROR  COURRIRNCES  OF  EXTENDED  KRLMRN  FILTER 
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Figure    15. e 
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plot  ap  E-:RRnR  cgurrjrhces  of  extended  krlmrn  filter 
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PLOT  OP  ERROR  COURRIRNCES  OF  EXTENDED  KRLMRN  FILTER 
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Figure    15. g 
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PLOT    OF   ERROR   COURRJRNCES   G.F   EXTENDED   KRLMRH  FILTER 
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Figure    15. h 
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PLOT  OF  ERROR  COURRIflNCES  OF  EXTENDED  KRLMflN  FILTER 
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PLOT    QF   ERROR   COURRJRNCE5   OF   EXTENDED   KRLKIRH  FILTER 
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PLOT  OF  ERROR  CQURRIRNCE5  OF  EXTENDED  KRLMRN  FILTER 


DEGREES  LRTITUDE 
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NAVIGATION  DATA  FILTER  PARAMETERS 

K  SGI       SG2       SP11  SP12      SP22        T 

1  0.0  0.0  1.00000  0.0  1.00000      0.0 

2  1.00000  0.05119380.66919  19.48511  1.00038  19.49 

3  0.99882  0.05108  1.14965  0.05879  0.00339  19.51 

4  0.98838  0.06558  0.08664  0.00575  0.00060  14.66 

5  0.98501  0.04940  0.08871  0.00445  0.00060  19.44 

6  0.99316  0.08664  0.00135  0.00012  0.00038      0.13 

7  0.98754  0.06699  0.08112  0.00550  0.00059  14.74 

8  0.98151  0.06026  0.05790  0.00355  0.00047  15.71 

9  0.97277  0.10268  0.02173  0.00229  0.00033      8.76 

10  0.94145  0.08600  0.01088  0.00099  0.00019      9.74 

11  0.94856  0.C8194  0.01346  0.00116  0.00022  10.51 

12  0.91888  0.15716  0.00328  0.00056  0.00014      4.17 

13  0.85980  0.11550  0.00249  0.00034  0.00008      5.86 

14  0.83806  0.13307  0.00140  0.00022  0.00006      3.91 

15  0.85071  0.07386  0.00388  0.00034  0.00013      9.81 

16  0.92033  0.12667  0.00475  0.00065  0.00014      5.93 

17  0.86281  0.12924  0.00202  0.00030  0.00008      4.63 

18  0.86374  0.08069  0.00394  0.00037  0.00012      8.95 

19  0.90294  0.13523  0.00327  0.00049  0.00011      5.06 

20  0.92028  0.05688  0.01188  0.00073  0.00027  14.82 

21  0.95677  0.14607  0.00857  0.00131  0.00026      5.58 

22  0.93741  0.06148  0.01462  0.00096  0.00026  14.05 

23  0.94708  0.20048  0.00123  0.00026  0.00020      0.99 

24  0.90285  0.21650  0.00257  0.00062  0.00017      3.98 

25  0.83907  0.10200  0.00214  0.00026  0.00007      5.91 

26  0.88344  0.07841  0.0050o  0.00045  0.00013      9.61 

27  0.95941  0.06027  0.02470  0.00155  0.00033  15.05 

28  0.94919  0.18175  0.00512  0.00098  0.00025      3.95 

29  0.92062  0.08575  0.00783  0.00073  0.00016      9.72 

30  0.98201  0.11463  0.00064  0.00008  0.00010      0.17 

31  0.96785  0.04331  0.04680  0.00209  0.00059  22.39 

32  0.96556  0.26431  0.00448  0.00123  0.00051      2.30 

33  0.96510  0.09523  0.01888  0.00186  0.00028      9.83 

34  0.96078  0.06154  0.02486  0.00159  0.00032  14.62 

35  0.97220  0.09061  0.02435  0.00227  0.00032  10.03 

36  0.93132  0.17870  0.00090  0.00017  0.00012      0.96 

37  0.91836  0.10144  0.00690  0.00076  0.00016      8.84 

38  0.96472  0.04517  0.03873  0.00181  0.00050  20.40 

39  0.95950  0.26424  0.00315  0.00087  0.00042      1.92 

40  0.89174  0.32614  0.00132  0.00048  0.00020      2.30 

41  0.88387  0.07968  0.00513  0.00046  0.00014      9.70 

42  0.98371  0.10944  0.00061  0.00007  0.00010      0.15 

43  .0.97027  0.03956  0.05574  0.00227  0.00070  24.59 

44  0.98900  0.09726  0.06107  0.00601  0.00070      9.78 

45  0.92971  0.13186  0.00517  0.00073  0.00015      5.63 

46  0.86633  0.12222  0.00233  0.00033  0.00008      5.17 

47  0.82393  0.12997  0.00128  0.00020  0.00006      3.95 

48  0.84651  0.07313  0.00376  0.00032  0.00013      9.82 

49  0.92028  0.12684  0.00475  0.00065  0.00014      5.92 

50  0.85657  0.13893  0.00165  0.00027  0.00007      3.97 

51  0.81387  0.10611  0.00171  0.00022  0.00006      5.65 

52  0.87628  0.08114  0.00449  0.00042  0.00012      9.13 

53  0.95511  0.06082  0.02183  0.00139  0.00031  14.77 

54  0.95369  0.15795  0.00706  0.00117  0.00025      4.94 

55  0.88339  0.12346  0.00296  0.00041  0.00010      5.63 

56  0.88633  0.08152  0.00496  0.00046  0.00013      9.15 

57  0.88925  0.17660  0.00147  O.C0029  0.00010      2.64 

58  0.87054  0.09397  0.00385  0.00042  0.00011      8.23 

59  0.94438  0.06346  0.01623  0.00109  0.00026  13.76 

60  0.95553  0.17797  0.00110  0.00020  0.00020      0.74 

61  0.95518  0.10369  0.01350  0.00147  0.00024      9.12 

62  0.90990  0.13526  0.00345  0.00051  0.00012      4.92 

63  0.85686  0.11034  0.00246  0.00032  0.00008      5.93 

64  0.89314  0.07766  0.00575  0.00050  0.00014      9.91 

65  0.90760  0.15759  0.00274  0.00048  0.00012      4.02 
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NAVIGATION  DATA  FILTER  PARAMETERS 


VELND 


ELAT 


SLATD 


VELED 


ELON 


SLOND 


1  -0. 

2  -0. 

3  -0. 

4  tO. 

5  -0. 

6  -0. 

7  -0. 

8  -0. 

9  -0. 
10  -0. 
11-0. 

12  -0. 

13  -0. 

14  -0. 

15  -0. 

16  -0. 

17  -0. 

18  -0. 

19  -0. 

20  -0. 

21  -0. 

22  -0. 

23  -0. 

24  -0. 

25  -0. 

26  -0. 

27  -0. 

28  -0. 

29  -0. 

30  -0. 

31  -0. 

32  -0. 

33  -0. 

34  -0. 

35  -0. 

36  -0. 

37  -0. 

38  -0. 

39  -0. 

40  -0. 

41  -0. 

42  -0. 

43  -0. 

44  -0. 

45  -0. 

46  -0. 

47  -0. 

48  -0. 

49  -0. 

50  -0. 

51  -0. 

52  -0. 

53  -0. 

54  -0. 

55  -0. 

56  -0. 

57  -0. 

58  -0. 

59  -0. 

60  -0. 

61  -0. 

62  -0. 

63  -0. 

64  -0. 

65  -0. 


00097 
00097 
00097 
00094 
00097 
00096 
00097 
00095 
00092 
0  0090 
00094 
00095 
00097 
00100 
00095 
00095 
0  0  097 
00096 
00092 
00033 
00072 
00066 
00074 
00060 
0  0  064 
00070 
00069 
00071 
00071 
00  069 
00069 
00072 
00070 
00070 
00069 
00067 
00065 
00070 
00  08  0 
00058 
00067 
00074 
00070 
00064 
00069 
00068 
00070 
00066 
00066 
00061 
00067 
00069 
G0070 
00070 
00071 
0006  9 
00067 
00069 
00071 
00072 
00075 
00072 
0  0  06  9 
00073 
00073 


0.0 
0.0 

0.00003 

0.00047 

■0.00066 

0.00014 

•0.00018 

0.00037 

0.00031 

-0.00078 

0.00055 

-0.00005 

■0.00018 

-0.00024 

0.00061 

0.00003 

-0.00015 

0. 00008 

0.00032 

0.00166 

0.00075 

0.00093 

•0.00041 

0.00063 

-0.00035 

■0.00076 

0.00015 

-0.00012 

0.00008 

0.00014 

0.00002 

-0.00012 

0.00024 

-0.00008 

0.00018 

0.00012 

0.00017 

-0  .00108 

-0.00040 

0.00069 

-0  .00119 

-0. 00060 

0.00096 

0.00058 

•0.00037 

0.00014 

-0.00017 

0.00053 

-0.00002 

0.00034 

-0.00049 

-0.00032 

-0.00012 

0.00002 

-0.00008 

0.00017 

0.00014 

-0. 00020 

-0.00031 

-0.00008 

-0.00032 

0.00026 

0.00027 

-0.00060 

0.00002 


33.35472 

33.33582 
33.31688 
33.30269 
33.28491 
33.28412 
33.27011 
33.25467 
33.24670 
33.23805 
33.22697 
33.22357 
33.21797 
33.21402 
33.20399 
33.19885 
33.19446 
33.1S562 
33. 18080 
33.16742 
33.16432 
33. 15494 
33.15518 
33.15184 
33.14882 
33.14235 
33.13112 
33.12852 
33.12146 
33.12140 
33.10605 
33.10446 
33.09723 
33.08723 
33.08009 
33.07959 
33.07331 
33.06073 
33.05833 
33.05611 
33.05110 
33.04994 
33.03119 
33.02527 
33.02220 
33.01826 
33.01570 
33.00870 
33.00523 
33.00259 
32.99940 
32.99294 
32.98242 
32.97885 
32.97493 
32.96838 
32.96669 
32.96130 
32.95168 
32.95087 
32.94423 
32.94022 
32.93619 
32.92961 
32.92613 


0.00106 
0.00103 
0.00103 
0.00104 
0.00105 
0.00092 
0.00100 
0.00103 
0.00110 
0.00103 
0.00099 
0.00099 
0. 00099 
0.00100 
0.00098 
0.00103 
0.00100 
0.00100 
0.00103 
0.00112 
0.00127 
0.00123 
0.00122 
0.00119 
0.00113 
0.00120 
0.00124 
0.00128 
0.00121 
0.00108 
0.00120 
0.00147 
0.00125 
0.00123 
0.00124 
0.00118 
0.00121 
0.00123 
0.00137 
0.00117 
0.00118 
0.00109 
0.00121 
0.00136 
0.00125 
0.00121 
0.00120 
0.00120 
0.00128 
0.00126 
0.00121 
0.00121 
0.00124 
0.00124 
0.00121 
0.00120 
0.00121 
0.00121 
0.00123 
0.00113 
0.00122 
0.00123 
0.00117 
0.00119 
0.00127 


0.0 

0.00339 
0.00391 
0.00335 
0.00426 
0.00063 
0.00411 
0.00385 
0.00274 
0.00161 
0.00181 
0.00121 
0.00166 
0.00157 
0.00231 
0.00202 
0.00125 
0.00245 
0.00169 
0.00536 
0.00273 
0.00333 
0.00110 
0.00096 
0.00155 
0.00379 
0.00463 
0.00162 
0.00188 
0.00074 
0.00810 
0.00211 
0.00024 
0.00341 
0.00285 
0.00095 
0.00251 
0.00590 
0.00152 
0.00008 
0.00295 
0.00110 
0.00895 
0.00425 
0.00102 
0.00151 
0.00169 
0.00319 
0.00262 
0.00161 
0.00165 
0.00284 
0.00454 
0.00146 
"0.00168 
0.00262 
0.00141 
0.00251 
0.00397 
0.00101 
0.00264 
0.00175 
0.00151 
0.00321 
0.00205 


120 
•120 
•120 
■120 
■120 

120 
■120 
■120 

120 
-120 
■120 
•120 
•120 

120 
•120 
■120 
•120 
-120 
•120 
■120 
-120 
■120 
-120 

120 

120 
-120 
■120 
■120 
-120 
•120 
-120 
•120 

120 
-120 
-120 
-120 
-120 
•120 
-120 
-120 
•120 
-120 
-120 
-120 
-120 
•120 
-120 
-120 
-120 
-120 
-120 
-120 
-120 
•120 
-120 
-120 
•120 
-120 
-120 
-120 
-120 
•120 
-120 
-120 
•120 


.90094 
.88036 
. 85689 
.33792 
.81435 
.81000 
.79581 
.77605 
.76324 
.74988 
.73749 
.73164 
.72475 
. 71945 
.70331 
.70053 
.69388 
.68384 
. 67664 
. 65984 
.64865 
.62817 
.62381 
.61790 
. 60997 
.59779 
. 57643 
.56711 
.55310 
. 55115 
.52617 
.51556 
.49902 
.48045 
.46437 
.46089 
.44954 
. 42265 
.41460 
.40997 
.39854 
.39574 
.36789 
.34735 
.33548 
. 32803 
.32196 
.30882 
. 29903 
.29149 
.28296 
.27060 
.25027 
. 23978 
.23140 
.21881 
.21332 
.20207 
.  18315 
. 17848 
. 16670 
. 15816 
.14929 
.13641 
. 12874 
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LOE  NUMBER  ASSIGNED  TO  TARGET  I 


8   9  10  11  12  13  14  15  16  17  18 


1 
2 

3 
4 
5 
6 

7 


2   4   6   7   9  10  14  15  19  28  32  33  37  40  42  48  53  54  59 
20  24  30  35  43  44  50  61  65 


5  18  29  34  41 

8  13  16  23  25  27  36  46  49  58  63  64 

11  17  21  26  38  45  51  55  60 

12  22  47  52  56  62 
31  39  57 
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MAL  JSET  DATA 


LOB  NUMBER  ASSIGNED  TO  TARGET  I 


8   9  10  11  12  13  14  15  16  17  18 


1 
? 
3 
4 
5 
6 
7 
8 
9 
0 
1 


1   2 

3  20  3 
5  18  2 
8  13 

11  17 

12  22 
31  39 
24 

23  25 
21  26 
62 


4  6  7  9 
0  35  43  44 
9  34  <tl 

6  46  49 

8  45  51  55  60 

7  52  56 
7 


10  14  15  19  28  32  33  37  40  42  48  53  54  59 
50  61  65 


27  36  58  63  64 
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KALMAN  FILTER  PARAMETERS  FOR  ANGLE  FILTER 


I 

J 

K 

Pll(K) 

P121K) 

GKK) 

G2(K) 

0 

1 

10000.0000 

0.0 

0.9858 

0.0 

2 

2 

3796832.0000 

194851.0625 

1.0000 

0.0513 

3 

4 

1524.5747 

32.8987 

0.9137 

0.0197 

4 

6 

280.4939 

4.7693 

0.6608 

0.0112 

5 

7 

152.7203 

2.2873 

0.5147 

0.0077 

6 

9 

145.1893 

1.7950 

0.5021 

0.0062 

7 

10 

91.3717 

1.0639 

0.3882 

0.0045 

8 

14 

95.3233 

0.9622 

0.3983 

0.0040 

9 

15 

69.6211 

0.6718 

0.3259 

0.0031 

10 

19 

73.6805 

0.6359 

0.33£5 

0.0029 

11 

28 

144.8281 

0.8791 

0.5014 

0.0030 

12 

32 

113.2626 

0.7491 

0.4403 

0.0029 

13 

33 

72.4155 

0.4980 

0.3346 

0.0023 

14 

37 

79.2565 

0.5709 

0.3550 

0.0026 

15 

40 

73.2924 

0.5326 

0.3373 

0.0025 

16 

42 

56.1020 

0.4119 

0.2  8  04 

0.0021 

17 

48 

93.4777 

0.6047 

0.3936 

0.0025 

18 

53 

96.7548 

0.6493 

0.4019 

0.0027 

19 

54 

61.8750 

0.4227 

0.3005 

0.0021 

20 

59 

76.1122 

0.5372 

0.3458 

0.0024 

2 

0 

3 

10000.0000 

0.0 

0.9858 

0.0 

2 

2 

20 

245938448.0000 

1568242.0000 

1.0000 

0.0064 

2 

3 

30 

538.0237 

3.6306 

0.7889 

0.0053 

2 

4 

35 

290.0398 

2.2160 

0.6682 

0.0051 

2 

5 

43 

276.5554 

1.8841 

0.6576 

0.0045 

2 

6 

44 

108.5593 

0.7722 

0.4298 

0.0031 

2 

7 

50 

104.9692 

0.8097 

0.4216 

0.0033 

2 

8 

61 

204.23S8 

1.2454 

0.5865 

0.0036 

2 

9 

65 

117.2222 

0.8081 

0.4487 

0.0031 

3 

0 

5 

10000.0000 

0.0 

0.9858 

0.0 

3 

2 

18 

105753904.0000 

1028366.6875 

1.0000 

0.0097 

3 

3 

29 

676.7473 

4.5293 

0.8246 

0.0055 

3 

4 

34 

240.9335 

1.6838 

0.6259 

0.0044 

3 

5 

41 

196.7235 

1.3391 

0.5  7  74 

0.0039 

4 

0 

8 

10000.0000 

0.0 

0.9858 

0.0 

4 

2 

13 

15236810.0000 

390341.7500 

1.0000 

0.0256 

4 

3 

16 

364.8191 

7.4582 

0.7170 

0.0147 

4 

4 

46 

6361.5547 

22.8240 

0.97  79 

0.0035 

4 

5 

49 

186.0658 

1.7933 

0.5637 

0.0054 

5 

0 

11 

10000.0000 

0.0 

0.9858 

0.0 

5 

2 

17 

11760551.0000 

342934.5625 

1.0000 

0.0292 

5 

3 

38 

10214.9727 

49.5509 

0.9861 

0.0048 

5 

4 

45 

334.0320 

2.8629 

0.6988 

0.0060 

5 

5 

51 

190.9865 

1.7584 

0.5701 

0.0052 

5 

6 

55 

15  5.5  254 

1.3744 

0.5192 

0.0  046 

5 

7 

60 

135.6935 

1.1037 

0.4852 

0.0039 

6 

0 

12 

10000.0000 

0.0 

0.9858 

0.0 

6 

2 

22 

61762576.0000 

785891.0625 

1.0000 

0.0127 

6 

3 

47 

2935.1575 

11.3428 

0.9532 

0.0037 

6 

4 

52 

228.4055 

2.1122 

0.6133 

0.0057 

6 

5 

56 

186.3982 

2.0266 

0.5642 

0.0061 

7 

0 

31 

10000.0000 

0.0 

0.9858 

0.0 

7 

2 

39 

47449840.0000 

688837.8750 

1.0000 

0.0145 

7 

3 

57 

1653.8228 

9.3628 

0.9199 

0.0052 

9 

0 

23 

10000.0000 

0.0 

0.9858 

0.0 

9 

2 

25 

977951.8125 

98884.2500 

0.9999 

0.1011 

9 

3 

27 

2646.6462 

86.8112 

0.9484 

0.0311 

9 

4 

36 

2056.0347 

21.4738 

0.9345 

0.0098 

9 

5 

58 

1380.1123 

5.8268 

0.9055 

0.0038 

9 

6 

63 

207.6056 

1.6897 

0.5905 

0.0048 

9 

7 

64 

101.2973 

0.9508 

0.4130 

0.0039 

10 

0 

21 

10000.0000 

0.0 

0.9858 

0.0 

10 

2 

26 

11934835.0000 

345466.2500 

1.0000 

0.0289 
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KALMAN  FILTER  PARAMETERS  FOR  ANGLE  FILTER 


I 

J 

K 

T(K) 

THTD(K) 

TDTD(K) 

E(K) 

GATE(K) 

0 

1 

0.0 

59.2273 

-0.0479 

2 

2 

19.485 

57.7483 

-0.0759 

-0.5454 

974.2915 

3 

4 

34.179 

56.1255 

-0. 0549 

1.0632 

20.4241 

4 

6 

19.573 

55.1541 

-0.0532 

0.1573 

10.3016 

5 

7 

14.742 

53.9223 

-0.0599 

-0.3703 

8.6128 

6 

9 

24.466 

52.5216 

-0.0591 

0.1281 

8.5028 

7 

10 

9.744 

51.7402 

-0.0615 

-0.5299 

7.6709 

8 

14 

24.439 

50.4772 

-0.0591 

0.6015 

7.7350 

9 

15 

9.806 

49.6654 

-0.0613 

-0.7137 

7.3079 

10 

19 

24.569 

47.8786 

-0.0637 

-0.8289 

7.3770 

11 

28 

73.938 

42.7536 

-0.0662 

-0.8239 

8.4975 

12 

32 

34.578 

40.5205 

-0.0659 

0.1300 

8.0197 

13 

33 

9.831 

39.7742 

-0.0665 

-0.2954 

7.3555 

14 

37 

34.441 

37.5330 

-0.0662 

0.1419 

7.4709 

15 

40 

24.613 

35.8449 

-0.0666 

-0.1759 

7.3704 

16 

42 

9.847 

35.1225 

-0.0671 

-0.2374 

7.0729 

17 

4  8 

58.940 

31.0783 

-0.0677 

-0.2278 

7.7052 

18 

53 

39.444 

28. 1404 

-0.0695 

-0.6683 

7.7581 

19 

54 

4.937 

27.7536 

-0.0698 

-0. 1458 

7.1742 

20 

59 

39.424 

24.7081 

-0.0719 

-0.8522 

7.4181 

2 

0 

3 

0.0 

62.3831 

-0.0473 

2 

2 

20 

156.824 

54.0991 

-0.0528 

-0.8639 

7841.2148 

2 

3 

30 

69.009 

51.0311 

-0.0489 

0.7317 

13.0578 

2 

4 

35 

59.161 

48.0350 

-0.0497 

-0.  1518 

10.4168 

2 

5 

43 

68.351 

46.0922 

-0.0396 

2.2497 

10.2537 

2 

6 

44 

9.783 

45.3923 

-0.0418 

-0.7265 

7.9461 

2 

7 

50 

34.46  1 

43.0553 

-0.0487 

-2. 1226 

7.8894 

2 

8 

61 

83.767 

38.9379 

-0.0490 

-0.0577 

9.3306 

2 

9 

65 

24.765 

37.8015 

-0.0484 

0.1693 

8.0812 

3 

0 

5 

0.0 

76.3184 

-0.0423 

3 

2 

18 

102.837 

73.9504 

-0.0230 

1.9865 

5141.8398 

3 

3 

29 

88.724 

70.5609 

-0.0320 

-1.6330 

14.3243 

3 

4 

34 

49.304 

69.2111 

-0.0304 

0.3671 

9. 8099 

3 

5 

41 

54.138 

67.6206 

-0.0300 

0.0988 

9.2293 

4 

0 

8 

0.0 

89.8662 

-0.  0351 

4 

2 

13 

39.034 

87.7937 

-0.0531 

-0.7037 

1951.7271 

4 

3 

16 

19.638 

86.8632 

-0.0508 

0.1565 

11.2785 

4 

4 

46 

251.067 

70.9110 

-0.0623 

-3.2701 

40.3285 

4 

5 

49 

19.688 

69.7662 

-0.0615 

0.1441 

9.0839 

5 

0 

11 

0.0 

88.4148 

-0.0363 

5 

2 

17 

34.293 

86.4644 

-0.0569 

-0.7063 

1714.6934 

5 

3 

38 

187.198 

76.1742 

-0.0551 

0.3616 

50.8895 

5 

4 

45 

54.068 

72.2144 

-0.0  63  5 

-1.3999 

10.9320 

5 

5 

51 

34.479 

69.2354 

-0.0708 

-1. 3831 

9.1513 

5 

6 

55 

34.468 

66.8928 

-0.0699 

0.1874 

8.6534 

5 

7 

60 

34.529 

63.3594 

-0.0790 

-2.3061 

8.3620 

6 

0 

12 

0.0 

52.8601 

-0.0490 

6 

2 

22 

78.589 

44. 0398 

-0.1122 

-4.9659 

3929.4629 

6 

3 

47 

201.919 

34.5715 

-0.0612 

13.8409 

27.7451 

6 

4 

52 

34.488 

32.3674 

-0.0621 

-0.1496 

9.6489 

6 

5 

56 

34.495 

23.9272 

-0.0762 

-2.3011 

9.0884 

7 

0 

31 

0.0 

48.3618 

-0.0478 

7 

2 

39 

68.884 

44.3147 

-0.05S8 

-0.7557 

3444.1973 

7 

3 

57 

132.894 

37.7173 

-0.0519 

1.3159 

21.2004 

9 

0 

23 

0.0 

37.0618 

-0.0497 

9 

2 

25 

9.888 

36.0716 

-0.1001 

-0.4992 

494.4937 

9 

3 

27 

24.660 

36.3181 

-0.0111 

2.8634 

26.4133 

9 

4 

36 

73.959 

33.0763 

-0.0364 

-2.5942 

23.4523 

9 

5 

58 

172.278 

24.4576 

-0.0463 

-2.5979 

19.5199 

9 

6 

63 

34  .466 

20.1427 

-0.0684 

-4.6048 

9.3756 

9 

7 

64 

9.906 

18.3441 

-0.0790 

-2.7139 

7.8310 

10 

0 

21 

0.0 

36.2854 

-0.  0497 

10 

2 

26 

34.547 

35.1806 

-0.0320 

0.6114 

1727.3518 
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TARGET    NUMBER       1 
FILTERED    AND    SMOOTHED    EMITTER    DATA    CORRELATED    TO    TARGET    NUMBER 


K       FREO 


1 

2 

4 

6 

7 

9 

10 

14 

15 

19 

28 

32 

33 

37 

40 

42 

48 

53 

54 

59 


2872.0 
2872.0 
2  8  72.0 
2872.0 
2872.0 
2872.0 
2872.0 
2872.0 
2872.0 
28  72.0 
2872.  0 
2872.0 
2872.0 
2872.0 
2872.0 
28  72.0 
2872.0 
2872.0 
2872.0 
2872.0 


PRF 

320.0 
322.0 
320.0 
318.0 
320.0 
319.0 
32  1.0 
320  .0 
320.0 
320.0 
319.0 
319.0 
320.0 
320.0 
320.0 
320.0 
319.0 
323.0 
320.0 
322.0 


Phi 

2.40 
2.50 
2.50 
2.40 
2.60 
2.20 
2.50 
2.60 
2.20 
2.40 
2.60 
2.50 
2.50 
2.40 
2.50 
2  .50 
2.30 
2.80 
2.50 
2.50 


THETAD 

59.2273 
57.7483 
56.2173 
55.  2075 
53.5000 
52.5854 
51.4160 
50.8  391 
49.  1843 
47.3303 
42.3428 
40.5933 
39.5776 
37.6245 
35.7283 
34.9517 
30.9402 
27.7407 
27.6516 
24. 1506 


THTD 

59.2273 

57.7483 
56.1255 
55.1541 
53.9223 
52.5216 
51.7402 
50.4772 
49.6654 
47.8786 
42  .7536 
40.5205 
39.7742 
37.5330 
35.8449 
35.1225 
31.0783 
28.1404 
27.7536 
24.7081 


SLAD 

33.3547 
33.3358 
33.3031 
33.2842 
33.2699 
33.2468 
33.2374 
33.2140 
3  3.2  045 
33.1813 
33.1284 
33.1044 
33.0974 
33.0738 
33.0555 
33.0494 
33.0092 
32.9823 
32.9788 
32.9514 


SLOD 

•120.8981 
•120.8769 
•120.8344 
•120.8093 
•120.7916 
■120.7605 
-120.7481 

120.7176 
■120.7058 

120.6743 
■120.5652 
■120.5135 
•120.4985 
■120.4462 
-120.4081 
•120.3945 
•120.3054 
•120.2458 
■120.2381 
•120.1793 


SMOOTHED    INITIAL    BEARING    ANGLE    = 
FILTERED    FINAL    BEARING    ANGLE    = 


59.22725  N 
24.70815  W 


VECTOR    METHOD    SOLUTION    OF    EMITTER    LOCATION 
EMITTER    LATITUDE    =       33.98700    N 
EMITTER    LONGITUDE    =-119.60393    U 
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TARGET    NUMBER       2 
FILTERED    AND    SMOOTHED    EMITTER    DATA    CORRELATED    TO    TARGET    NUMBER       2 

K       FREO         PRF         PW            THETAD  THTD                  SLAD                  SLOD 

3    2876.0    306.0    2.40         62.3831  62.3831          33.3169    -120.8529 

20    2378.0    304.0    2.40          54.0991  54.0991          33.1691    -120.6545 

30    2878.0    306.0    2.30          51.1855  51.0311          33.1215   -120.5503 

35    2876.0    306.0    2.30          47.9846  48.0350         33.0803    -120.4621 

43  2876.0    306.0    2.40          46.8625  46.0922          33.0322    -120.3590 

44  2876.0  306.0  2.30  44.9730  45.3923  33.0258  -120.3431 
50  2876.0  306.0  2.50  41.8276  43.0553  33.0027  -120.2898 
61  2876.0  306.0  2.30  38.9141  38.9379  32.9440  -120.1640 
65    2876.0    306.0    2.40          37.8948  37.8015         32.9261    -120.1269 

SMOOTHED    INITIAL    BEARING    ANGLE  =       62.38292    N 

FILTERED    FINAL    BEARING    ANGLE  =       37.80147    W 


VECTOR    METHOD    SOLUTION    OF    EMITTER    LOCATION 

EMITTFR    LATITUDE    =       34.09401    N 

EMITTER    LONGITUDE    =-119.02849    W     • 
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TARGET    NUMBER      3 
FILTERED    AND    SMOOTHED    EMITTER    DATA    CORRELATED    TO    TARGET    NUMBER 

K       FREO         PRF         PW  THETAD  THTD  SLAD  SLOD 

5    2846.0    370.0  2.30  76.3184  76.3184  33.2843    -120.8101 

18    2846.0    370.0  2.30  73.9504  73.9504  33.1857   -120.6813 

29    2846.0    370.0  2.40  70.2744  70.5609  33.1215    -120.5511 

34    2846.0    370.0  2.40  69.3484  69.2111  33.0872    -120.4769 

41    2846.0    370.0  2.40  67.6624  67.6206  33.0495    -120.3957 

SMOOTHED    INITIAL    BEARING    ANGLE    =       76.31851    N 
FILTERED    FINAL    BEARING    ANGLE    =       67.62057    W 


VECTOR    METHOD    SOLUTION    OF    EMITTER    LOCATION 
EMITTER    LATITUDE    =       33.78937    N 
EMITTER    LONGITUDE    =-118.17609    W 
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TARGET    NUMBER       4 
FILTERED    AND    SMOOTHED    EMITTER    DATA    CORRELATED    TO    TARGET    NUMBER       4 

K       FREO  PRF  PW  TFETAD  THTD  SLAD  SLOD 

8    5556.0    320.0     1.00  89.8662  89.8662         33.2550  -120.7721 

13    5554.0    640.0    1.10  87.7937  87.7937  33.2177  -120.7229 

16    5556.0    320.0    1.00  86.9075  86.8632         33.1988  -120.6985 

46    5554.0    640.0    0.90  70.8386         70.9110  33.0182  -120.3263 

49    5554.0    320.0    1.00         69.8291  69.7662         33.0054  -120.2964 

SMOOTHED    INITIAL    BEARING    ANGLE    =       89.86671    N 
FILTERED    FINAL    BEARING   ANGLE    =       69.76620    W 


VECTOR    METHOD    SOLUTION    OF    EMITTER    LOCATION 
EMITTER    LATITUDE    =       33.25092    N 
EMITTER    LONGITUDE    =-119.49136    W 
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TARGET  NUMBER   5 
FILTERED  AND  SMOOTHED  EMITTER  DATA  CORRELATED  TO  TARGET  NUMBER   5 

K   FREO    PRF    PW     THETAD      THTD       SLAD       SLOD 

11  5506.0  640.0  0.60    88.4148    88.4148    33.2275  -120.7356 

17  5504.0  640.0  0.60    86.4644    86.4644    33.1942  -120.6923 

38  5504.0  640.0  0.60    76.1792    76.1742    33.0597  -120.4169 

45  5506.0  640.0  0.70    71.7927    72.2144    33.0218  -120.3343 

51  5504.0  642.0  0.60    68.6409    69.2354    32.9989  -120.2809 

55  5504.0  640.0  0.60    66.9829    66.8928    32.9749  -120.2294 

60  5504. 0  642.0  0.60    62.1721    63.3594    32.9508  -120.1774 

SMOOTHED  INITIAL  BEARING  ANGLE  =   88.41481  N 
FILTFRED  FINAL  BEARING  ANGLE  =   63.35942  W 


VECTOR  METHOD  SOLUTION  OF  EMITTER  LOCATION 
EMITTER  LATITUDE  =   33.25052  N 
EMITTER  LONGITUDE  =-119.45798  W 
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TARGET    NUMBER       6 
FILTERED    AND    SMOOTHED    EMITTER    DATA    CORRELATED    TO    TARGET    NUMBER 

K       FREO         PRF  PW  TFETAD  THTD  SLAD  SLOD 

12    2876.0  359.0    2.20  52.8601  52.8601  33.2234   -120.7302 

22    2876.0  359.0    2.20  44.0398  44.0398  33.1556    -120.6249 

47    2876.0  359.0    2.40  35.2188  34.5715  33.0157    -120.3198 

52    2874.0  359.0    2.40  32.3096  32.3674  32.9926   -120.2671 

56    2876.0  359.0    2.20  27.9243  28.9272  32.9686    -120.2162 

SMOOTHED    INITIAL    BEARING    ANGLE    =       52.85960    N 
FILTERED    FINAL    BEARING    ANGLE    =       28.92722    W 

VECTOR    METHOD    SOLUTION    OF    EMITTER    LOCATION 
EMITTER    LATITUDE    =       33.95410    N 
EMITTER    LONGITUDE    =-119.55852    W 
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TARGET    NUMBER       7 
FILTERED    AND    SMOOTHED    EMITTER    DATA    CORRELATED    TO    TARGET    NUMBER 

K       FREO         PRF         PW  THETAD  THTD  SLAD  SLOD 

31    9268.0    500.0    0.20         48.3618         48.3618         33.1060    -120.5182 
39    9268.0    499.0    0.20  44.3147  44.3147  33.0578    -120.4130 

57    9270.0    500.0    0.30  37.8228  37.7173         32.9668   -120.2116 

SMOOTHED    INITIAL    BEARING    ANGLE    =       48.36174    N 
FILTERED    FINAL    BEARING    ANGLE    =       37.71735    W 

VECTOR    METHOD    SOLUTION    OF    EMITTER    LOCATION 
EMITTER    LATITUDE    =       34.12042    N 
EMITTER    LONGITUDE    =-119.12958    W 
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TARGET    NUMBER       8 
FILTERED    AND    SMOOTHED    EMITTER    DATA    CORRELATED    TO    TARGET    NUMBER      3 


K       FREO         PRF  PW  THETAD 

24    2676.0    305.0    2.40  19.1616 


THTD  SLAD  SLOD 

33.1525    -120.6167 


SINGLE  LINE  BEARING 
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TARGET    NUMBER       9 
FILTERED   AND    SMOOTHED    EMITTER    DATA    CORRELATED    TO    TARGET    NUMBER 


K 

FREO 

PRF 

PW 

THE  TAD 

THTD 

SLAD 

SLOD 

23 

5556. 0 

640.0 

1.00 

37.0618 

37.0618 

33.1548 

-120.6227 

25 

5556.0 

320.0 

l.LO 

36.0715 

36.0716 

33.1482 

-120.6078 

27 

5554.0 

640.0 

1.10 

36.4658 

36.3181 

33. 1312 

-120.5719 

36 

5554. 0 

640.0 

1.10 

32.9065 

33.0763 

33.0797 

-120.4598 

58 

55  56.0 

640.0 

1.00 

24.2122 

24.4576 

32.9610 

-120.1989 

63 

5556.0 

640  .0 

1.00 

18.2568 

20. 1427 

32.9362 

-120.1472 

64 

5556.0 

320.0 

1.10 

16.7510 

18.3441 

32.9291 

-120.1331 

SMOOTHED    INITIAL    BEARING    ANGLE    =       37.06157    N 
FILTERED    FINAL    BEARING    ANGLE    =       18.34413    W 

VECTOR    METHOD    SOLUTION    OF    EMITTER    LOCATION 
EMITTER    LATITUDE    =       34.27957    N 
EMITTER    LONGITUDE    =-119.59087    W 
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TARGET    NUMBER     10 
FILTERED    AND    SMOOTHED    EMITTER    DATA    CORRELATED    TO    TARGET    NUMBER    10 

K       FREO         PRF         PW  THETAD  THTD  SLAD  SLOD 

21    5504.0    640.0    0.60         36.2854         36.2354         33.1652    -120.6456 
26    5504.0    640.0    0.60         35.1807  35.1806         33.1417    -120.5935 

SMOOTHED    INITIAL    BEARING    ANGLE    =       36.28545    N 
FILTERED    FINAL    BEARING    ANGLE    =       35.18065    W 

VECTOR    METHOD    SOLUTION    OF    EMITTER    LOCATION 
EMITTER    LATITUDE    =       35.15515    N 
EMITTER    LONGITUDE    =-118.84724    W 
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TARGET    NUMBER    11 

FILTERED    AND    SMOOTHED    EMITTER    DATA    CORRELATED    TO    TARGET    NUMBER    11 

K       FREO         PRF         PW  TFETAD  THTD  SLAD  SLOD 

62    2874.0    359.0    2.40  59.5566  32.9406    -120.1563 

SINGLE    LINE    BEARING 
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c 

c 

C  MASTER  CCNTROL  PROGRAM 

C 

C  DESCRIPTION  OF  VARIABLES  IN  THE  COMMON  BLOCK 

C 

C  AC LAD 

C  ACL  AMD 

C  ACLAR  -  AIRCRAFT  LATITUDE  READ  FORM  DATA 

C  ACLOD 

C  ACLOMD 

C  ACLOR  -  AIRCRAFT  LONGITUDE  READ  FROM  DATA 

C  ALT  -  AIRCRAFT  ALTITUDE 

C  BRNG 

C  BRNGD  -  CF  BEARING  ANGLE  (TRUE  OR  RELATIVE,  DEPENDING 

C  ON  DATA  SOURCE) 

C  F  KALMAN  FILTER  ERROR  -ERM  IN  ANGLE  FILTER 

C  FREO  -  SIGNAL  FREQUENCY  IN  MEGACYCLES 

C  Gl 

C  G?  -  KALMAN  FILTER  GAINS 

C  GATE  -  TEST  FOR  DF  BEARING  CORRELATION 

C  HDG 

C  HDGD  -    AIRCRAFT    HEADING    (TRUE) 

C  MODEN 

C  MODET  -  MODE  OF  DATA  COLLECTOR  OPERATION 

C  NST  -  NUMBER  OF  DF  BEARINGS  CORRELATED  TO  A  TARGET 

C  Pll 

C  P12 

C  P22  -  ERROR  COVARIANCE  TERMS 

C  PITCH  -  LONGITUDINAL  ATTITUDE  OF  AIRCRAFT 

C  PRF  -  SIGNAL  PULEE  REPITION  FREQUENCY 

C  PRF  -  SIGNAL  PULSE  REPITION  FREQUENCY 

C  PW  SIGNAL  PULSE  WIDTH 

C  ROLL  -  TRANSVERSE  ATTITUDE  OF  AIRCRAFT 

C  SLA 

C  SLAD  -  FILTERED  AND  SMOOTHED  AIRCRAFT  LATITUDE 

C  SLO 

C  SLOD  -  FILTERED  AND  SMOOTHED  LONGITUDE  OF  AIRCRAFT 

C  T  TIME  3ETWEEN  DATA  SETS  (SECONDS) 

C  TIMEN  -  TIME  ]P  NAVIGATIONAL  FIXES 

C  TIMET  -  TIME  OF  TAKING  DF  BEARING 

C  TDTD  -  DF  BEARING  ANGLE  RATE 

C  THTD  -  FILTERED  DF  BEARING  ANGLE 

C  THTD1  -  SMOOTHED  FIRST  OF  BEARING  ANGLE 

C  THETA 

C  THETAD-  DF  BEARING  ANGLE  FROM  DATA  (TRUE) 

C  TLAD  -  TARGET  LATITUDE  FROM  ANGLE  FILTERING 

C  TLOD  -  TARGET  LONGITUDE  FROM  ANGLE  FILTERING 

C  VEL  -  AIRCRAFT  SPEED  OVER  THE  GROUND 

C  VELE  -  AIRCRAFT  VELOCITY  IN  EAST  DIRECTION  (NEGATIVE 

C  DENOTES  AIRCRAFT  HEADING  WEST) 

C  VELN  -  AIRCRAFT  VELOCITY  IN  NORTH  DIRECTION  (NEGATIVE 

C  NUMBER  INDICATES  THAT  THE  AIRCRAFT  IS  HEADING 

C  XTD1  -  TARGET  LONGITUDE  FROM  EXTENDED  KALMAN  FILTER 

C  YTD1  -  TARGET  LATITUDE  FROM  EXTENDED  KALMAN  FILTER 

C  Dll  -  COVARIANCE  OF  ERROR  OF  SMOOTHED  FIRST  DF 

C  BEARING 

C  JST  -  NUMBER  OF  DF  BEARINGS  FILTERED  IN  ANGLE  FILTER 

C  BEFORE  PROCESSING  SWITCHED  TO  EXTENDED  KALMAN 

C 

C  VARIABLES  COMMON  THROUGHOUT  PROGRAM 

C 

C  JSET  -  MATRIX  RELATING  DATA  SETS  TO  TARGETS 

C  PTLAT  -  MATRIX  OF  LATITUDE  OF  INTERSECTION  OF  ERROR 

C  CONES  ASSOCIATED  WITH  EACH  BEARING 

C  PTLON  -  MATRIX  OFLCNGITUDE  OF  INTERSECTION  OF  ERROR 

C  CONES  ASSOCIATED  WITH  EACH  DF  BEARING 

C  NSTA  -  NUMBER  OF  DF  BEARINGS  CORRELATED  TO  A  TARGET 

C  JSTA  -  NUMBER  OF  DF  BEARINGS  FILTERED  BEFORE 

C  PROCESSING  SWITCHED  TO  EXTENDED  KALMAN  FILTER 

C 

C  » o 
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COMMON     ACL  AD ( 100  J. ACL A MD{ 100),ACLAR{ 100  J  ,ACLOD( 100)  , 
lACLOMD(lOO) . ACLOR( 100) , ALT (100 ),BRNG(100),BRNGD(100), 
2E(  100)  ,FREQ(  100)  ,G1(100)  ,G2(100)  ,GATEdOO) ,HDG(100), 
3HDGD(  10  0),MCDEN(  100),MQDET( 100) ,NST{  100)  ,P11( 100)  , 
4P121100) ,P22( 100) .PITCH (100) , PR F( 100 ),PW( 100), 
5 ROLL (100),SLA(100),SLAD(100),SLO(100)  , SLOD(IOO)  , 
5T(100) .TIM  EN (100 ), TIMET (100) ,TDTD( 100),THTD( 100)  , 
6THTDK  100)  .THETA(IOO)  , THETAO(IOO)  ,TLAD(100  ),TL0D(100), 
7VEL( 100)  ,VELE(  100) , VELN( 100) ,XTD( 100) ,  YTDt 100) , 
8D1K100)  ,JST(100) 

DIMENSION    J  SET ( 15,50)  , PTL AT ( 4, 1 5 , 50 ) , PTL0N(4,15 ,50), 
1X3(101) ,Y3(  101  ) 

DATA    IX/531/,STDEV/1./,STDEVN/ .5/ , AMEAN/O . / 

DATA    TEST/. 7/ 

DATA    J  DIM/ 2/ 

DATA     SIGMA/1./ 

DATA    RNAV/.25/ 

CATA    RXTEND/.05/ 

KFLAG=1 

DATA    EXTEST    /3.0/ 

DATA    RCUT,TSTCUT,JDIM    /144.,.5,15/ 

CALL    READ(NUM) 

CALL    NAV(NUM,RNAV, TEST) 

CALL    GEORGE ( NUM, NT AR,R CUT, RXT END, EXT EST, TSTCUT  , SIGMA, 
1JSET,PTLAT,PTL0N, J  DIM) 
C 
C 
C  SUBROUTINE    TO    COMPUTE    FINAL    EMITTER    TARGET    JSET    DATA 

WRITE(6,66) 

WRITE{6,202) 

WRITE(6.203) (K,K=1, 18) 

00    30     I=1,NTAR 

NSTA=NST(I ) 

WRITE (6, 204) I,  (  JSETd  ,  J) ,J=1,NSTA) 

30  CONTINUE 
K2  =  0 

WRITE(6. 55) 
WRITE(6,53) 

DO    32    I=1,NTAR 

NSTA=NSTd  ) 

IF(NSTA.EO.l)     GO    TO    32 

KI=JSFT( I ,1) 

WRITE (6.64)     I,K2,KI,P11(KI),P12(KI),G1(KI) ,G2(KI) 

JSTA^JSTd  ) 

DO    31    J=2.JSTA 

K=JSET (I, J) 

WRITE (6,64)     I  ,  J,K,P11 (K) ,P12(K) ,G1(K),G2(K) 

31  CONTINUE 

32  CONTINUE 
WRITF(6,55) 
WRITF( 6. 54) 

DO    35     I=1.NTAR 

NSTA=NST(I) 

IF(NSTA.EO.l)     GO    TO    35 

KI=JSET{  1,1  ) 

WRITE (6, 65) I ,K2,KI ,T(KI ) .THTD(KI) ,TDTD(KI ) 

JSTA=JST(I  ) 

DO    34    J=2,JSTA 

K=JSET(  I  ,J) 

WRITE (6, 65)     I, J,K,T(K),THTD(K) ,TDTD(K) , E { K) ,GATE ( K) 

34  CONTINUE 

35  CONTINUE 
C 

DO   37     I=1.NTAR 
WRITE(6,59)I 
NSTA=NST(I  ) 
WRITE(6,52) I 
IF(NSTA.EO.l)     GO    TO    110 
JSTA  =  JST( I  ) 
DO    45    J=1,JSTA 
K=JSET( I, J) 
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45 


46 
110 

37 


WRITE16.51) (K, FREO(K) 
1SLAD(K) ,SLOD(K) ) 
CONTINUE 

IF(ABS(TLAD(  I)  )  .LE.1E-6)    GO    TO    46 
KF=JSFT( I , JSTA) 

68)THT01(KF),THTD(KF) 

70)  TLADCI ) ,TLOD( I) 
FQ.JSTA)    GO    TO    37 
I, NSTA) 

71)  YTD(KF) 


PRF(K) ,PW(K) ,THETAD( K) ,  THTD(K) 


XTD(KF) 


WRITE(6, 
WRITE(6, 
IF(NSTA. 
KF=JSET ( 
WRITF(6, 
GO  TO  3  7 
WRITF(6,205) 
GO  TO  3  7 
K=JSFT{ 1,1) 

WRITE (6.67 )K,FREQ(K),PRF(K) 
1SLAD(K) ,SLQD(K) 
WRITE(6,200) 
CONTINUE 


PW(K) ,THETAD(K ), 


51 
52 


53 

54 

55 

59 
64 
65 
66 
67 
68 


70 


71 


20  0 
202 
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c 

c 

C  SUBROUTINE  NAV ( NUM, RNAV , TEST ) 

C 

C  SUBROUTINE  TO  FILTER  AND  SMOOTH  NOISY  AIRCRAFT 

C  NAVIGATION  DATA 

C 

C  LIST    OF    VARIABLES 

C 

C  All 

C  A12 

C  A21 

C  A22    -  SMOOTHING  FILTER  GAINS 

C  ELAT   -  LATITUDE  FILTER  ERROR  TERM 

C  ELAD1 

C  ELAD2  -  LATITUDE  SMOOTHING  FILTER  ERROR  TERM 

C  ELON   -  LONGITUDE  FILTER  ERROR  TERM 

C  ELON1 

C  ELON2  -  LONGITUDE  SMOOTHING  FILTER  ERROR  TERM 

C  LEG1   -  SUBSCRIPT  CORRESPONDING  TO  FIRST  NAV  FIX  IN  A 

C  LEG 

C  LEG2   -  LAST  NAV  FIX  IN  A  LEG 

C  LW     -  WORK  VECTOR  FOR  MINV 

C  MW     -  WORK  VECTOR  FOR  MINV 

C  PIN    -  MINV  ARGUMENT 

C  PIN11 

C  PIN12 

C  PIN22  -  INVERSE  OF  ERROR  COVARIANCE  MATRIX 

C  Oil 

C  012 

C  022    -  VARIANCE  OF  SYSTEM  NOISE 

C  SLAD   -  AIRCRAFT  LATITUDE 

C  SLATD  -  PREDICTED  AIRCRAFT  LATITUDE  ESTIMATE 

C  SLOND  -  PREDICTED  AIRCRAFT  LONGITUDE  ESTIMATE 

C  SLOD   -  AIRCRAFT  LONGITUDE 

C  SGI 

C  SG2    -  KALMAN  FILTER  GAIN 

C  S  P  I  I 

C  SP12 

C  SP22   -  ERROR  COVARIANCE  TERM  -  (K+llK) 

C  SPKK11 

C  SPKK12 

C  SPKK22-  ERROR  COVARIANCE  TERM  -  (K|K) 

C  TT     -  TIME  INCREMENT  DIVIDED  BY  W 

C  VELED  -  AIRCRAFT  VELOCITY  EAST  IN  DEGREES 

C  VELEDS-  SMOOTHED  AIRCRAFT  VELOCITY  EAST 

C  VELEM  -  AIRCRAFT  VELOCITY  EAST  IN  KNOTS 

C  VELND  -  AIRCRAFT  VELOCITY  NORTH  IN  DEGREES 

C  VELNDS-  SMOOTHED  AIRCRAFT  VELOCITY  NORTH 

C  VELNM  -  AIRCRAFT  VELCCITY  NORTH  IN  KNOTS 

C  NLEG   -  NUMBER  OF  LEGS 

C  RNAV   -  VARIANCE  OF  MEASUREMENT  NOISE 

C 

c 

C 

SUBROUTINE    NAtf ( NUM, RNAV, TEST ) 
C 

COMMON    AC LAD (100), ACLAMD(IOO) , ACLAR(IOO) , ACLOD(IOO), 
1ACL0MD(100),ACL0R( 100) , ALT ( 100) ,BRNG( 100) ,BRNGD(100) , 
2E(100),FREQ(100),G1(100),G2(100) , GATE (100 ) ,HDG( 100), 
3HDGD( 10  0),M0DEN(  100),M0DET( 100)  ,NST(100)  , PI 1(100)  , 
4P12(100),P22(100  ),  P  ITCH  (  100)  ,PRF(  100),  PW(  100)  , 
5R0LLC 100), SLA (100) ,SLADSM(100) , S LO ( 100 ), S LCDS M( 100 ) , 
5T(100),TIMEN(100),TIMET( 10  0) ,TDTD( 100) ,THTD( 100) , 
6THTDK100)  ,THETA(100)  ,  THET  AD  1 1  00  )  ,  TL  AD(  100),TLCD(  100). 
7VEL(  100)  ,VFLE(  ICO)  , VELN(IOO)  ,XTD(100) ,YTD(100), 
8D11(100),JST(100) 

DIMENSION    All (100) , A12 (100) ,A2 1(100 ),A22(100), 
1ELAT(100).ELAD1( 100) ,ELAD2( IOC)  , ELON (100)  , EL0NK100) , 
2ELON2(100) ,LEG1(50 ),LEG2(50),LW(2),MW(2),PIN(2,2), 
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c 
c 
c 
c 
c 


c 
c 
c 
c 
c 


c 
c 
c 


c 
c 
c 


3P IN 11 (100). PIN  12 (100) ,PIN22(100)  ,011(100) ,012(100) , 

4  022(100).SLAD(100) ,  SLATDQ00) ,SLOND( 100), SLOD( 100) 
5,SG1(100),SG2«100),SP11(100),SP12(100),SP2  2(100), 
6SPKK1K  100) ,SPKK12(  100) ,SPKK22( 1001  ,TT(  100) ,VELED( 100) 
7,VFLEDS( 100) ,VELEM( 100) , VELND ( 100  ), VELNDS ( 100), 
8VELNM( 100) 

DATA    PIRAD/57. 29578/ 

PROGRAM    TD    FILTER    NOISY    MEASURED       LATITUDE    AND    LONGITUDE 

DIVIDE    THE    FLIGHT    TRACK    INTO    LEGS    FOR    FILTERING 

L  =  l 

LFGK  1)  =  1 

DO    1    K=2.NUM 

KK=K-1 

TKM1=TIMET(KK) 

T(K)=TIMET(K)-TKM1 

IF(T(K) .LE. 120.0)    GO    TO    1 

LEG2IL)=KK 

LEGKL  +  1  )  =  K 

L  =  L  +  1 

CONTINUE 

LFG2(L)=NUM 

NLEG=L 

START    OF    KALMAN    FILTER    PREDICTION    PROBLEM 

INITALIZE    KALMAN    FILTER 

DO    100    L=1,NLEG 

LEG2L=LEG2(L) 

LEG1L=LEG1 (L ) 

KI=LEG1L 

ELON(KI )=0.0 

ELATtKI )=0.0 

T(KI)=0.0 

SGKKI  )  =  0.0 

SG2(KI )=0.0 

SPKK1K  KI)=1. 

SPKK12(KI )=0. 

SPKK22(KI)=1. 

SP1KKI  )  =  1. 

SP12(KI )=0. 

SP22(KI)=1. 

SLAD(KI  )=ACLAD(KI ) 

SLATDtKI  )=ACLAD(KI ) 

SLA( KI ) =ACLAR( KI ) 

VELND(KI )={ ACLADiKI+1     J-ACLAD(KI) }/T(KI+l) 

SL0ND1KI )=ACLOD(KI ) 

VELNM(  KI)=  VELND  (KI  ):; 216000. 

SLOD(KI )=ACLOD(KI) 

VELEDtKI  )=( (ACL0D(KI+1  J-ACLOD(KI)  )/T(KI  +  l)  )• 

VELEMl  KI  )=VELED(  KI  )'r  216000. 

START    OF    KALMAN    FILTER    RECURSION    EQUATIONS 

LG1P1=LEG1L+1 

CO    6    K=LG1P1,LEG2L 

KK  =  K- 1 

TT(K)=T(K) /1000.0 

011(K)=TT(K)**4/4.0 

012(K)=TT(  K)-?t3/2.  0 

p22fK)=TTtK)**2 

COMPUTE    KALIAN    FILTER    GAINS 

SP11(K)=SPKK11 (KK)+(2.0*SPKK12(KK)+SPKK22(KK)*T(K) )* 
1T(K)+011(K) 

SP12(K)  =  SPKK12iKK)+SPKK22(KK)';  T(K)+012(K) 
SP22(K) =SPKK22 (KK)+Q22 (K) 


C0S(SLA(KI 
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SG1(K)=SP11(K) /( SP11(K)+RNAV* T(K)/3600. ) 

SG2(K)  =  SP12{K)/(SPll(K)+RNAV-!  T(K)/3600.  ) 

SPKK11 (K)  =  SP11  (K)* (1.0-SG1 (K)) 

SPKK12(K)  =  SP12(K  )?  (  1.0-SGKK)) 

SPKK22 (K)=SP22(K)-SP12  1K)*SG2(K) 
f. 

C       FILTER    LATTITUDE 
C 

IFLAG=1 
700       SLATD(K)=SLAD(KK)+VELND(KK)*T(K) 

ELAT(K)=ACLAD(K)-SLATD(K) 
C 

C   TEST  FOR  EXCESS  SYSTEM  NOISE 
C 

IF(ABS( ELAT(K) ) . LT.TEST)  GO  TO  800 
C 

C   THE  DATA  POINT  ACLAD(K)  IS  INVALID,  SO  IT  IS  DISCARDED 
C 

IFUFLAG.E0.2)  GO  TO  800 

ACLAD(  KK)  =  SLATD(KK  ) 

ELAT(KK)=0. 

SLADIKK )=SLATD(KK) 

VELND(KK)=VELND(KK-1) 

VELNM( KK)=VFLNM( KK-1) 

SLA(KK)=SLAD(KK)/PIRAD 

IFLAG=2 

GO    TO    700 
800       IFLAG=1 
C 

C       THE    DATA    POINT    ACLAD(K)     IS    VALID,     SO    PROCEED 
C 

SLAD(K)  =SLATD(K)+SG1  (K)'*  ELAT(K) 

VELND(K)=VELND(KK)+SG2(K)*ELAT(K) 

VELNM(K)=VELND(K):''2160  00. 

SLA(K) =SLAD(K) /PIRAD 
C 

C   FILTER  LONGITUDE 
C 
900   SLOND(K)=SLOD(  KK  )  +-  VELE  D(  KK  )»;T  (  K) 

ELON(K) =(ACLOD(K)-SLOND(K) )*COS(SLA(K) ) 
C 

C      TEST    FOR    EXCESS    SYSTEM    NOISE 
C 

IF(ABS(ELON(K) > .LT.TEST)     GOTO    1000 
C 

C       THE    DATA    POINT    ACLOD(K)    IS     INVALID,     SO    IT    IS    DISCARDED 
C 

IFUFLAG.E0.2)     GO    TO    1000 

ACLOD(KK)=SLOND(KK) 

FLON(KK)=0. 

SLOD(KK)=SLOND(KK) 
,   VELED(KK)=VELED(KK-1) 

VFLEM(  KK)  =  VELEM(  KK-1) 

IFLAG=2 

GO    TO    900 
1000     IFLAG=1 
C 

C       THE    DATA    POINT    ACLOD(K)    IS    VALID,     SO    PROCEED 
C 

SLOD(K)=SLOND(K)+SGHK)-'  ELON(K) 

VELFD(K)  =(  VELED(KK)+SG2(KK  ELON(K)  )*COS(SLA(K)  ) 
6  VELEM(  K)  =VELED  (  K);?216000. 

100       CONTINUE 
C 

C       START    OF    FIXED    INTERVAL    SMOOTHING    EQUATIONS 
C 

DO    13    L=1,NLEG 

LEG2L=LFG2(L ) 

LEGIOLEGI  (D 

N=LEG2L-LEG1L 

IF(N.LE.3)     GO    TO     11 
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c 
c 


c 
c 
c 


c 
c 
c 


c 
c 
c 


10 


c 
c 
c 
c 


INITALIZE     SMOOTHING    FILTER 

SLADSM(LEG2L)=SLAD(LEG2L) 

VELNDS(  LEG2L)=VELND( LEG2L) 
SLODSM( LEG2L)=SL0D(LEG2L) 
VELEDSC  LEG2L)  =  VELEC(LEG2L) 

COMPUTE    SMOOTHING    FILTER    GAINS 

DO    10    1=1, N 

K=LEG2L-I 

KK=K+1 

PIN( 1, 1)=SP11( K) 

PIN( 1,2  )=SP12( K J 

PIN(2,1 )=SP12(K) 

PIN( 2, 2)=SP22(K) 

CALL    MINV(PIN. 2,DET,LW,MWJ 

PIN11(K)=PIN(1 ,1 ) 

PIN12(K )=PIN( 1,2) 

PIN22(K)=PIN(2,2) 

A11(K)=SPKK11(K)''PIN11(K)+SPKK12(K)>'(PIN11 
1 P  I N 1 2  (  K  )  ) 

A12(K)=SPKK11(K)#PIN12(K)+SPKK12(K)*(PIN12 
1P1N22C K)  ) 

A21(K)  =  SPKK12(K)=:  P  I  Nl  1  (  K  )  +  SPKK22  (  K  )  *  (PIN  11 
1PIN12CKJ  ) 

A22(K)=SPKK12( K)*PI N12 I K) +SPKK22 (K) * (PIN12 
1PIN22(K)  ) 

SMOOTH    LATITUDE    ESTIMATES 

ELAD1(K)=SLADSM(KK)-SLATD(KK) 

ELAD21 K)=VELNDS( KK ) -VE LND( KK) 

SLADSM(K)  =  SLAD(K)+A11(!<)*ELAD1(K)+A12{K)*E 

VELNDS(K)=VELND(K)+A21 ( K)*EL AD1 ( K )+A22( K )* 

VELNDS(K)  =  VELND(K)+(A21(K)+A22(K)  )*ELAD1(K 

SLA(K)=SLADSM(K)/PIRAD 

SMOOTH  LONGITUDE  ESTIMATES 

EL0N1(K)=(SLCDSM(KK)-SL0ND(KK) )*COS (SLA(K) 
EL0N2(K)=( VELEDS(KK)-VELED(KK)  )  *.  COS  (  SLA  (  K) 
SLODSM(K)  =  SL0D(K  J  +  All  {  K  )=*EL0N1  (  K  )  +A  12(  K  )#E 
VELEDS(  K)=VELED(K)  +  A21  (K)*  EL0N1  (K)+A22(K)^ 

SLO(K)=SLODSM(K)/PIRAD 

CONTINUE 

GO  TO  13 


(K)*T(K)+ 
(K)-*T<K)  + 
(K)^T(K)  + 
(K)*T(K)+ 


TO  ANY  LEGS  WITH  3  OR  LESS  POINTS,  ASSIGN  THE 
AS  THE  FILTERED  AND  SMOOTHED  VALUES  FOR  THAT 


LAD2(K) 

ELAD2CK) 

) 


) 
) 

L0N2(K) 
EL0N2CK) 


DATA  VALUES 
LEG 


11 


12 
13 


50 
51 
52 

53 


DO    12    J=LEG1L, LEG2L 
SLADSMC  J)=SLAD( J) 
SLA( J)=SLAD(J)/PIRAD 
VELNDS( J  )=0. 
SLODSM( J)=SLOD( J) 
SLO( J)=SLOD( J) /PIRAD 
VELEDS( J)=0. 
CONT  INUE 

52) 

53) 

50) 

,:MUM) 

52) 

54) 

51)(K,VELND(K),ELATU),SLATD(K),VELED(K), 

SLONDC K) ,K=1, NUM) 

24X,     14,     5F9.5.     F9.2) 

24X,     14,    2F9.5,     F11.5 


WRITE(6, 

WRITE16. 

WRITE(6. 
1T(K) ,K=1 

WRITE( 6. 

WRITE(6, 

WRITFJ6, 
1EL0N( K) , 

FORMAT ( 

FORMAT { 

FORM  AT  (  • 
1»     PARAMETERS" 

F0RMAT(27X,     • 


U,SG1{K),SG2(K),SP11(K),SP12(K),SP22(K), 


//////, 38X, 
,  //  ) 

K1 


2F9.5,    Fll. 

•NAVIGATION    DATA    FI 


5) 

LTER'  , 


6X,     'SG2',    6X,     'SPll'i     5X, 
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1«SP12'.  5X, 

54    FORMAT (  27X, 
14X,  ' VELED' , 
RETURN 
END 


•SP221,  7X,  «T«,//) 
• K« ,3X.'VELND«.  5X»  'ELAT't  7X, 
5Xt  •ELONlt  5Xf  'SLOND',  //) 


•SLATD1 
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c  . 

c 

C  SUBROUTINE    GEORGE ( NUM , NTAR , RCUT , RXT END, EXTEST, TSTCUT , 

C  1SIGMA, JSET,PTLAT,PTLCN,JDIM) 

C 

C  THIS    FORTRAN    PROGRAM    IS    DESIGNED    TO    ANALYZE    AND    SORT 

C  ELECTRONIC    EMITTER    PARAMETERS    AND    AIRCRAFT    NAVIGATION 

C  DATA.     TO    FILTER    EMITTER    DATA    USING    KALMAN    FILTER    TECH- 

C  NIOUES    TC    MINIMIZE    BEARING    ANGLE-GF-ARP I VAL    MEASUREMENT 

C  NOISE.    TC    SMOOTH    INITIAL    UNFILTERED    BEARING    ANGLES, 

C  AND    TO    PREDICT    EMITTER    LOCATIONS    USING    VECTOR 

C  METHODS 

C 

C      LIST  OF  VARIABLES  NOT  IN  COMMON  BLOCK 

C 

C  NJSET    -    DATA    POINTS    TO    BE    ASSOCIATED    TO    A    TARGET 

C  TDTD1    -     SMOOTHED    BEARING    RATE 

C  TPTD       -    THETAD(K+ll K) 

C  TT  -    VARIANCE    OF    SYSTEM    NOISE 

C  Wll 

C  W12 

C  W21 

C      W22    -  SMOOTHING  FILTER  GAINS 

C      X3     -  X  COORDINATE  OF  ERROR  ELLIPSE 

C      Y3     -  Y  COORDINATE  OF  ERROR  ELLIPSE 

C      SMOTH1 

C      SM0TH2 

C      S MOTH 3 

C      SMOTH4-  INTERMEDIATE  TERMS  IN  SMOOTHING  COMPUTATIONS 

C      DELFRE-  CARRIER  FREQUENCY  TEST 

C      DELPRF-  PULSE  REPITION  FREQUENCY  TEST 

C      NTAR   -  NUMBER  OF  TARGETS 

C      RCUT   -  VARIANCE  OF  DF  BEARING  MEASUREMENT  ERROR 

C      RXTEND-  VARIANCE  OF  MEASUREMENT  NOISE  IN  EXTEND 

C      EXTFST-  MULTIPLIER  FOR  TEST  TO  SWITCH  TO  EXTEND 

G      TSTCUT-  MULTIPLIER  FOR  BEARING  CORRELATION  TEST 

C      SIGMA  -  MULTIPLIER  TO  VARY  SIZE  OF  ERROR  ELLIPSE  AS 

C  DEFINED  BY  POINTS 

C 

C 

C 

SUBROUTINE    GEO RGE { NUM , NTAR , RCUT ,RXT END , EXTEST , TSTCUT , 
1SIGMA, JSET.PTLAT,PTLGN, J  DIM) 
C 

COMMON    AC LAD (100) , ACL AMD (100) ,ACLAR(100) ,ACLOD(100), 
1ACLOMD(100),ACLOR( 100), ALT ( 100) , BRNG( 100) ,3RNGD(100) , 
2E(100).FREQ(100),G1(100),G2{100 ) , GAT E { 100 ) , HDG( 100), 
3HDGD( 100), MODEN ( 100) ,MODET( 100 ) , NST ( 100 ) , P 1 1 ( 100) , 
4P12C100) ,P22( 100 ), PITCH ( 100) ,PRF(  100J.PWC  100)  , 
5R0LL( 100) , SLA ( 100) ,SLAD(100) ,SL0(100) ,SLOD(100), 
5TI100), TIM  EN ( 100), TIMET ( 100) , TDTD ( 1 00)  , THTD ( 100 )  , 
6THTDK100)  .THETA(IOO)  , THETAQ(  100  )t  TLADt  100),TLOD(  100), 
7VEL(  100)  ,VELE(  100)  , VELN(IOO)  ,XTD(100) ,YTD(100), 
8D1K  100),  JST(IOO) 

DIMENSICN    JSET( J  CI M, 50) , NJSET (100) , PTL AT ( 4 , JD IM , 50 ) , 
1PTL0N(4. JDIM. 50) ,011(100) ,0121 100) ,Q22( 100) , 
2T0TD1  (100)  .TPTD  (100  )  , TT 1 100 ) , W 1 1 (  100J.W12C  100), 
3W2K  100) ,W22(100) , X3 ( 101) , Y3 ( 101) 
C 

DATA    PIRAD/57. 29578/ 
C 

C  PROGRAM    TO    SORT    EMITTER    TARGET    DATA    AND    ESTIMATE    NUMBER 

C         OF    DISTINCT    EMITTER    TARGETS 

C         DATA    IS    INITIALLY    SORTED    BY    FREQUENCY    AND    PRF 
C 

CUTERR=3  ,5*S0RT( RCUT) 
DO     1     1=1, NUM 
1  NJSET(I)=I 

NF=NUM 
DO    6    1=1, NUM 
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K=NJSET( 1) 

JSETd  ,1  )=K 

NSORT=NF 

NF  =  0 

NJ  =  1 

DO    5    J=2.NSORT 

KK=NJSFT(J ) 

DELFRE=FREQ(K)-FREQ(KK) 

DELPRF=PRF(K)-PRF(KK) 

IFCABS(DELFRE) .Lt.30.0. AND. ABS ( DELPRF ) .LE.IO.)    GO    TO    4 

IF(ABS( DELFRE) .GT.30.0)     GO    TO    3 

IF(PRF( K) .EQ.O.O.OR.PRF(KK1 -EO.O.O)    GO    TO    4 

DO    2    L=2.2 

RK=L*PRF(KK) 

TK=PRF(KK) /FLOAT(L) 

SK=PRF(K ) 

CK=ABS(RK-SK) 

DK=ABS(  TK-SK) 

FK=L#10.0 

IF(CK.LE.FK.OR.DK.LE.FK)     GO    TO    4 

CONTINUE 

NF=NF+1 

NJSET(NF)=KK 

GO    TO     5 

NJ^NJ+1 

JSETd. NJ)=KK 

CONTINUE 

NSTd  )  =  NJ 

IF(NF.LE.l)     GO    TO    7 

NTAR=I+1 

IFCNF.EO.OJ    GO    TO    8 

NTAR=NTAR+1 

JSET(NTAR. 1)=NJSET( 1) 

NST(NTAR)=1 

WRITFC  6,202) 

WRITE16.203) (K,K=1, 18) 

DO    9    I =1 ,  NTAR 

NSTA=NST(I J 

WRITE  16,  204)1,  (JSETd,  J  ),J=1,NSTA) 

CONTINUE 

PROGRAM    TO    FILTER    NOISY    MEASURED    BEARING    ANGLE    THETAD(K) 
AND    AIRCRAFT    NAVIGATION    DATA    FOR    EACH    SUSPECTED    EMITTER 
TARGET    OF    SIMILAR    FREQUENCY    AND    PRF 

INITIALIZATION    OF    KALMAN    FILTER    EQUATION    PARAMETERS 

IFLAG=1 

NTAR1=1 

NUMTAR=NTAR 

DO    27    I=NTAR1,NUMTAR 

NJ  =  0 

NSTA2=NST( I ) 

NSTA  =  NST(I  ) 

IF(NSTA.EQ.l)    GO    TO    27 

KI=JSETl I, 1) 

Pll(KI) =10000.0 

P12HKI  )=0.0 

P22(KI )=10000.0 

Q1KKI  )  =0.0 

012(KI  }  =  0.0 

022 (KI 1=0.0 

D1KKI  )  =1.0 

W1KKI  )=1. 

W12CKI )=0. 

W2KKI  )  =0. 

W22CKI )=1. 

G2(KI)=P12(KI)/  (P1KKI  J+RCUT) 

G1(KI)=P11(KI)/(P11(KI)+RCUT) 

THTDtKI )=THETAD(KI  ) 

THTD1(KI)=THETAD(KI) 
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™™<KH=V£L(KI)*SIN(BRNG(KI))*  PI  RAD/600000.0 

TDlDllKIJ=T  DT  D  (  K  I  J 

T(KI1=0.0 
C 

C    START  OF  KALMAN  FILTER  PREDICTION  PROBLEM 
C 

DO  23  J=2,NSTA2 

11  K=JSFT(I.J) 
KK=JSET( I. J-l) 
TKM1=TIMFT(KK) 
T(K)=TIMET(K)-TKM1 
TT(K)=T(K)/1000.0 
OIKK  )=TT(K)**4/4.0 
Q12(K)=TT(K)>**3/2.0 
022(K)=TT(  K)>*^2 

C 

C  START    OF    KALMAN    FILTER    RECURSION    EQUATIONS 

C 

P11(K)  =  P11(KK)*<  l.O-GKKK)  ) +2.  0*P12  (  KK)  *T  <  K) -(  P12  (KK)* 
1G1(KK)+P11(KK)*G2(KK))*T(K)+(P22(KK)-P12(KK)*G2(KK) )* 
2T(KK*2  +  Q11(K) 

P12(K)  =  P12(KK)*(  l.O-GKKK)  )+( P22{ KK)-P12( KK)*G2( KK)  }* 
1T(K)+Q12(K) 
P22(  K)=P22(KK)-P12{KK)*'G2{KK)+022(K) 
G1(K)=P11(K)/(P11(K)+RCUT) 
G2{K)=P12(K)/(P11(K)+RCUT) 
TPTD(K)=THTD(KK)+TDTD(KK)fcT(K) 

12  E(K)=THETAD(K)-TPTD(K) 
THTD(K)=TPTD(K)+G1  (K)*E(K) 
TDTD(K)=TDTD(KK)+G2(K)*E(K) 

C 

C         CORRELATION    GATING    SCHEME    TO    ESTIMATE    WHETHER    FILTERED 

C  BEARING    ANGLE    THTD(K)     IS    AN    EMISSION    FROM    EMITTER    TARGET 

C         NTAR    =    I    OR    A    SPURIOUS    EMISSION 

C 

GATE(K)=SQRT(Pll(K)+RCUT)fcTSTCUT 

IF(ABS(E(K) J.LT.GATE(K) )    GOTO    22 

13  IF( IFLAG.EO.l)  GO  TO  14 
IF(IFLAG.E0.2)  GO  TO  17 
GO  TO  18 

14  IF(THETAD(KK).LT. 10.0. AND. THETADC K) . GT. 350.0)  GO  TO  15 
IF(THETAD(KK).GT. 350.0. AND. THETAD(K).LT. 10.0)  GO  TO  16 
GO  TO  20 

15  THETAD(K)=THETAD(K)-360.0 
THETA(K)=THETA(K)-6.283186 
IFLAG=2 

GO  TO  12 

16  THETAD(K)=THETAD(K)+360.0 
THETA(K)=THETA(K)+6. 283186 
IFLAG=3 

GO  TO  12 

17  THETAD(K)=THETAD(K)+360.0 
THETA(K)=THETA(K)+6.283186 
GO  TO  19 

18  THETAD(K)=THETAD(K)-360.0 
THETA(K)=THETA(K)-6. 283186 

19  IFLAG=1 

20  NJ=NJ+1 

JSET  (NTAR+1,NJ)=K 

NST(NTAR+1)=NJ 
C 

C   THTD(K)  IS  A  SPURIOUS  BEARING  LINE  AND  IS  ASSIGNED  TO  A 
C   NEW  TARGET. 
C 

NST(  I)=NST(  I)-l 

NSTA2  =  NST(I  ) 

IF1NSTA2.LT.J)  GO  TO  24 

DO  21  L=J.NSTA2 

21  JSET(I.L)=JSET(I , L+ 1 ) 
GO  TO  11 

22  IFLAG=1 
C 


171 


C    SMOOTHING  EQUATIONS  FOR  FIRST  BEARING  LIME  ESTIMATE 
C 

SMOTHl=l .O-Pll i KK)* ( 1. 0-G1 (KKJ ) /RCUT 

SM0TH2  =  SM0THlr':T(K) 

SMOTH3  =  -P12  (KK)*  ( 1  .  O-Gl  (  KK  )  J/RCUT 

SMOTH4=l«,0+SM0TH3'-*T(K) 

Wl 1 ( K ) =W 1 1 i KK  5 * S  MOTH1  +  W 12  I KK ) -S  MOTH2 

W12(K)=W11{  KK)'::SM0TH3+W12(KK)-!  SMGTH4 

W2HK)=W21(KKH  SMOTH  1  +  W22(  KK  )  -''SM0TH2 

W22(K)  =  W21(  KK)  "■'SM0TH3  +  W22  (  KK  ):;"SM0TH4 

01 1  (  K  )  =D  1 1  {  KK  )-W  1 1  (  K)  <: -'■-  Zt  {  PI  1  {  KK  )  +RCUT)  /RCUT**2 

THTD1(K)=THTDHKK)  +  (W11(K)/RCUT)*E(K) 

TDTDKK)  =TDTD1  (  KK)  +  ( W2  1  (  K  )  /RCUT  )*E(  K  ) 

jst(  n  =  j 

IFCP11  (K).LT.(EXTESTSRCUT))  GO  TO  25 

23  CONTINUE 
C 

C    FILTFRED  BEARING  ANGLE  THTD(K)  IS  CORRELATED  TO  EMITTER 

C    TARGET  NTAR  =  I 

C 

24  IFINSTA2  .NE.NSTA}    NTAR=NTAR+1 
IF(NSTA2.EQ.l)     GO    TO   27 

C 

C    PROGRAM  TO  COMPUTE  TARGET  POSITION 

C 

KI---JSET(  1,1) 

KF=JSET( I.NSTA2) 

CALL  PREPAR  ( KI  , KF , SLAD, SLOD ,THTD1 ( KF)  ,  THTDC KF )  , 
1TLADCI ) .TLODU ) ) 

GO  TO  27 
C 
C   PROCESSING  SWITCHES  TO   EXTENDED  KALMAN  FILTERING 


C 


25  CALL    POINTSd,  J,  SIGMA,  RCUT,  Dll  ,HDGD.  JSET  »  Pll ,  SLAD, 
1SL0D,THTD1,THTD,PTLAT,PTL0N,JDIM,627) 

DO    26    N  =  l,4 
X3(N)=PiL0N(N»I,J) 

26  Y3(N)=PTLAT(N,  I,  J) 

CALL    EXTENDI  I, J , NST A2 , RXTEND,TSTCUT, JSET , NST, SLAD, 
1SL0D,T,THETA,THETAD,THTD1,THTD,TLAD,TL0D,XTD,YTD,X3, 
2Y3.JDIM) 

IF(NSTA2. NE.NSTA)     NTAR=NTAR+ 1 

27  CONTINUE 
IF(NUMTAR.EO.NTAR)     RETURN 
NTAR1=NUMTAR+1 

GO    TO    10 

202  FORMAT! e  Is  ,35X, • LOB  NUMBER  ASSIGNED  TO  TARGET  I«,//) 

203  FORMAT!  26X,  1813,  //) 

204  FORMAT (20X, 13,  3X,  3213) 
END 
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c  . 

c 

C  SUBROUTINE    EXTENDU , J ,NSTA, RXTEND , TSTCUT , JSET, NST , 

C  1SLAD,SL0D,T,THETA,THETAD,THTD1,THTD,TLAD,TL0D,XTD, 

C  2YTD,X3,Y3, JDIM1 

C 

C  SUBROUTINE  TO  COMPUTE  EMITTER  LOCATION  USING  EXTENDED 

C  KALMAN  FILTERING  TECHNIQUES. 

C 

C  LIST  OF  VARIABLES 

C 

C  I       -  TARGET  NUMBER 

C  J       -  CUT  NUMBER  CORRELATED  TO  TARGET  I 

C  A       -  SEMI-MAJOR  AXIS  OF  ERROR  ELLIPSE 

C  C         SEMI-MINOR  AXIS  GF  ERROR  ELLIPSE 

C  ALPHA   -  ANGLE  CF  ROTATION  OF  ERROR  ELLIPSE 

C  THETA   -  VECTOR  CF  DF  BEARINGS 

C  SLAD    -  VECTOR  OF  A/C  LATITUDES  IN  DEGREES 

C  SLA     -  VECTOR  OF  A/C  LATITUDES  IN  RADIANS 

C  SLOD    -  VECTOR  CF  A/C  LONGITUDES 

C  SLO     -  VECTOR  OF  A/C  LONGITUDES 

C  NST     -  VECTOR  OF  NUMBER  OF  CUTS  IN  EACH  TARGET 

C  RXTEND  -  VARIANCE  OF  MEASUREMENT  NOISE 

C  TSTCUT  -  VARIABLE  USED  TO  VARY  SIZE  OF  GATE 

C  YT      -  LATITUDE  OF  TARGET 

C  YTD     -  LATITUDE  OF  TARGET 

C  TLAD    -  LATITUDE  OF  TARGET 

C  XT      -  LONGITUDE  OF  TARGET 

C  XTD     -  LONGITUDE  OF  TARGET 

C  TLOD    -  LONGITUDE  OF  TARGET 

C  ATI     -  DISTANCE  FROM  TARGET  TO  A/C  IN  DEGREES 

C  AT2     -  DISTANCE  FROM  TARGET  TO  A/C  IN  DEGREES 

C  TX      -  BEARING  FROM  A/C  TO  TARGET 

C  DMX/DM  -  RATE  OF  CHANGE  OF  DF  BEARING  WITH  RESPECT 

C  TO  CHANGE  OF  LONGITUDE  OF  TARGET 

C  DMY/DM  -  RATE  OF  CHANGE  OF  DF  BEARING  WITH  RESPECT 

C  TO  CHANGE  OF  LATITUDE  OF  TARGET 

C  GY      -  KALMAN  FILTER  GAIN  IN  Y 

C  GX      -  KALMAN  FILTER  GAIN  IN  X 

C  ER      -  DF  BEARING  ERROR 

C  NSTA    -  NUMBER  OF  CUTS  CORRELATED  TO  TARGET  I 

C  GATE    -  TEST  OF  CORRELATION  OF  DF  CUTS 

C  Pll     -  VARIANCE  OF  ERROR  IN  LONGITUDE 

C  P12     -  COVARIANCE  OF  LATITUDE  ERROR  WITH 

C  LONGITUDE  ERROR 

C  P22     -  VARIANCE  OF  ERROR  IN  LATITUDE 

C  Oil     -  COVARIANCE  OF  SYSTEM  ERRORS 

C  012     -  COVARIANCE  OF  SYSTEM  ERRORS 

C  022     -  COVARIANCE  OF  SYSTEM  ERRORS 

C  FPU 

C  EP12 

C  EP22   -  POSITION  ERROR  COVARIANCE  TERMS  FOR  LINEAR 

C  FILTERS 

C  Gl 

C  G2                  LINEAR    FILTER    GAINS 

C  XTDDOT   -    XTDKK+1  IK) 

C  XTD1      -    ESTIMATE    OF    TARGET    LONGITUDE 

C  YTD1       -    ESTIMATE    OF    TARGET    LATITUDE 

C  YTDDOT-    YTDKK+llKJ 

C  EX                  LONGITUDE    ERROR 

C  FY            -    LATITUDE    ERROR 

C 

C 

c 

SUBROUTINE    EXTENDI  I , J , NSTA , RXTEND , TSTCUT , JSET , NST , 
1SLAD,SL0D,T,THETA,THETAD,THTD1,THTD,TLAD,TL0D,XTD, 
2YTD,X3,Y3,JDIM) 
C 

DIMENSION    Pll  (30)  ,  P12  (  80)  ,  P22  (  80  )  ,XT  {  80  )  ,  XTD(  80  )  ,  YT  I  80 
1 YTD (80) , SLA( 80) , SLAD( 80) , SLO (80)  , SLOD I  80)  ,  THETA (80)  , 
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c 
c 
c 


DATA  PIRAD/57. 29578/ 

EXTENDED  KALMAN  FILTER  INITIALIZATION 

WRITE(6,102)J.  I 
K1=JSET( I  ,1) 
KI  =  JSET(  I.J) 


C 
C 
C 
C 
C 
C 
f. 
C 


C 

c 
c 


c 
c 
c 


c 
c 
c 

c 
c 
c 


CALL    PREPAR     (Kl , KI , SLAD, SLOD,THTDl ( K I ) , THT D( KI ) , 
1TLADI I) .TLOD( I ) ) 

TLAD,    TLOD    IS    THE    CURRENT    ESTIMATE    OF    THE    TARGET 
POSITION. 

X3.Y3    ARE    THE    LOCATIONS    OF    THE    INTERSECTIONS    OF    THE 
EDGES    OF    THE    TWO    ERROR    CONES. 

TLA=TLAD(I )/PIRAD 
DFLX=(X3(1)-X3(2)  }*COSlTLA) 
DELY=Y3( 1)-Y3(2) 
ALPHA1=ATAN2(DELX,DELY) 
ALPHA2=ALPHA1-1 .57  3796  3 
ALPHAD=ALPHA1*PIRAD 

ALPHAD    IS    THE    ANGLE    OF    ROTATION    OF    THE    ELLIPSE 

DELX=(TLC1D(  I  )-X3(2)  )^:COS(TLA) 

DELY=TLADiIi-Y3(2  5 

A  =  SQRT(DELX*'*2+DELY*#2) 

A    IS    THE    SEMI-MAJOR    AXIS 

DO    19    K=3.4 

DELX=(TLOD(I )~X3(K) l*COS(TLA) 
DFLY=TLAD( I )-Y3( K) 
BETA  =  ATAN2(DELX,DELY) 
GAMMA=ALPHA2-BETA 
19         Z(K)=SQRT(DELX**2+DELY**2)*'COS(GAMMA} 
C=(ABS(Z(3) )+ABS(Z(4)  )  J/2.0 

C    IS    THE    SEMI-MINOR    AXIS 

WRITE(6,103)     ALPHAD, A, C 

INITIALIZE  THE  KALMAN  FILTERS 

WRITEC6. 561 

YTD(KI J-TLADU ) 

XTD(KI )=TLDDII } 

XTIKI )=XTD(KIJ/PIRAD 

YT(KI !=YTD(KI) /PIRAD 

SLA(KI )=5LAD(KI ) /PIRAD 

SLO(KI)=SLOD(KI ) /PIRAD 

CA=COS(ALPHAl) 

SA=SIN(  ALPHAD 

Pll  (KI  )=  (A-SA)  **2+(C*CA)**2" 

P12(KI  )=SA-fCA*  (  A*-2-C*-''2) 

P221KI  )=  (A*CA)**2+(C*'SA)*#2 

AT1=«XT(KI 1-SLOIKI ) J^'COS  ( YT  (  KI  ) ) 

AT2=YT( KI)-SLA( KI) 

TX(KI  )=ATAN2(AT1,AT2) 

ERIKI )=THETA(KI)-TX(KI ) 

DM=(  YTD(  KI)-SLAD(KI  )  )  *-'•  2+ (  XTD(  K  I  ) -SLOD(  KI  )  )**2 
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c 
c 
c 
c 
c 


c 
c 
c 


1*(C0S(YT(KI ) ))**2 

DMX(KI  )=(YTD(KI)-SLAC(KI)  ):'  COS  (  YT  (  K  I  )  J /DM 

DMY(KI )=-{XTD( KI )-SLOD(KI ) )*( (YTD(KI )-SLAD ( KI ) ) * 
1  S  I N  (  YT  (  K  I  )  )  +CD  S  (  YT  (  K I  )  )  J  /  DM 

DG  =  PI  1  (  K  I  )  *  DMX  <  K I )**2  +2 .0*  P12 ( K I )  *DMX  { K  I  )*  DMY  (  K  I  ) 
1+P22(KI  KDMY(K  I  )>?n-2+RXTEND 

GX(KI)  =  <P11(KI  )';-DMX(KI  )  +  P12(  K  I  )*DMY(K  I  )  J/DG 

GYCKI  )=(  P12JKI  }•:  DMX(KI)  +  P22(KIK-DMY(KI)  )/DG 

EP1KKI  )  =  P11(KI) 

EP12(KI  )=P12(KI  ) 

EP22(KI )=P22(<I ) 

G1(KI)=EP11(KI)/(EP11(KI J+RXTEND) 

G21KI )=EP12(KI )/(EPll(KI)+RXTEND) 

EX(KI 1=0.0 

EYCKI )=0.0 

XTDDOTC KI) =.001 

XTOKKI  )=XTD(KI  )+GX(K  I  )*ER(KI  ) 

YTDOnT(KI  )  =  .O01 

YTDK KI ) =YTD(KI ) +G Y ( K I ) * ER ( KI ) 

START    OF    KALMAN    FILTER    PREDICTION    PROBLEM 

COMPUTE    GAINS    FOR    LINEARIZED    FILTER 

NSTA=NST(I) 
JP1=J+1 

DO    12    JJ=JP1.NSTA 
20         K=JSETi I ,JJ) 

KK=JSET( I.JJ-1) 

SLA( K)=SLAD(K) /PIRAD 

SLO( K)=SLOD(K) /PIRAD 

TT(K)=T(K)/1E3 

011(K)=TT(K)***4/4.0 

G12<K)=TT(K)**3/2.0 

022(K)=TT(K)**2 

START    OF    EXTENDED    KALMAN    FILTER    RECURSION    EQUATIONS 


C 
C 

c 
c 
c 


Pll(K) = 

1DMY(KK) 
P12(K)= 

lDMY(KK) 
P22(K)= 

lDMX(KK) 
DM=(YTD 

1*(C0S  (Y 
DMX(K) = 
DMY(K)= 

1SIN(  YT( 
DG=P11( 

1P22(KJ-' 
GX(K)=( 
GY(K)=( 
AT1=(XT 
AT2=YT( 
TX(K)^A 
ER(KJ=T 


Pll(KK)*  (l.O-GXCKKl^DMXtKK)  J-P12(KK)*GX(KK)* 
+  01KK) 

(1.0-GX(KK)*DMX(KK)  )-P22(KK  KGX(KK)* 


(  1.0-GY(KK)*DMY{KK)  )  -P  12  (  KKKGYC  KK)* 


-SLOD(K)  )$*2 


P12(KK) 
+  Q121K) 

P22(KK) 

+  Q22  (K) 

( KK)-SLAD(K) )**2+(XTD(KK) 

T(KK) ))**2 

(YTD(KK)-SLADCK)  )>vCOS  ( YT  (  KK  )  )  /  DM 

-(XTDUK)-SLOD(K)  )$(  ( YT  D(  KK  J-SLAD  (  K  )  )* 

KK) )+COS(YT( KK) ) ) /DM 

K  )*DMX(K)*#2+2.0£P12(K )*DMX( K) *DMY( K)  + 

DMY(K)**2+RXTEND 

P11(K)£DMX(K)+P12(K)*DMY(K)  )/DG 

P12(K)fDMX(K  )+P22(K);<DMY(K)  J/DG 

(KK)-SLO(K) }*COS(YT(KK) ) 

KK)-SLA(K) 

TAN2(AT1,AT2) 

HETA(K)-TX{KJ 


CORRELATION    GATING   SCHEME    TO    ESTIMATE    WHETHER    FILTERED 
BEARING    ANGLE    THTD(K)     IS    AN    EMISSION    FROM    EMITTER    TARGET 
NTAR    =     I     OR    A    SPURIOUS    EMISSION 


GATE(K)=S0RT(P1KK)+RXTEND)*TSTCUT 

IF(ABS(ER(K) ) .LT.GATE(K))    GO    TO   II 
GO    TO    3 
GO    TO    6 


IF( IFLAG.EQ.l) 
IF( IFLAG.E0.2) 
GO    TO    7 

IF(THETAD(KK) . 
IF(THETADJKK). 
GO    TO    9 

THETA(K)=THFTA(K) 
IFLAG=2 


LT.10.0.AND.THETADCK1.GT.350.0)    GO 
GT. 3  50.0. AND. THE TAD (K) .LT.10.0)     GO 


-6.203186 


TO 
TO 
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GO  TO  1 

5  THETA(K)=THETA(K)+6. 283186 

IFLAG=3 
GO  TO  1 

6  THFTA( K)=THFTA(K)+6. 283186 
GO  TO  8 

7  THETA(K)=THETA(K)-6. 233186 

8  IFLAG=1 

9  NJ=NJ+1 

JSET  <NTAR+1,NJ)=K 

NST(NTAR+1)=NJ 
C 

C       THTD(K)     IS    A    SPURIOUS    BEARING    LINE    AND    IS    ASSIGNED    TO    A 
C       NEW    TARGET. 
C 

NSTC I)=NST(I)-1 

NSTA=NST(I ) 

IF(NSTA.LT.JJ)     GO    TO    13 

DO    10    L=JJ.NSTA2 

10  JSET( I,L)=JSET( I,L+1) 
GO  TO  20 

11  IFLAG=1 
C 

C   COMPUTE  GAINS  FOR  LINEAR  FILTERS 
C 

EP11(K)=EP11(KK)*(  1.0-GKKK)  )  +  2.0^EP12(  KK)*T(K)- 
1(EP12(KK)*G1(KK)+EP11(KK)*G2(KK))*T(K)+(EP22(KK)- 
2EP12(KK)-,G2(KK)  )  *T  (  K)**-2+Qll  (  K) 

FP12(K)=EP12(KK)*(  1.0-GKKK)  )  +  (  EP22  (  KK)-E  P12  (  KK)  * 
2G2(KK) )*T(K)+012(K) 

EP22(K)=EP22(KK)-EP12(KKKG2(KK)+Q22(K) 

Gl (K)=EP11(K)/ (EPllCKJ+RXTENDJ 

G2(K)  =  FP12(K)/(  EPIKKJ+RXTEND) 
C 

C       FIND    REST    ESTIMATES    OF    TARGET    LONGITUDE,     XTD1,    AND    TARGET 
C       LATITUDE.     YTD1 
C 

YTDHAT(K)=YTD( KK ) +YTDDOT ( KK )*T ( K ) 

EY(K) =YTD1( KK)-YTDHAT(  K) 

YTD(K)=YTDHAT(K)+G1(K  ):;  EY(K) 

YTDDOT ( K )=YTDDOT ( KK  J  +G2 ( K )* EY ( K  J 

YTDK  K)  =  YTD(K)+GY(K)-ER(K) 

YT(K)=YTD1(K)/PIRAD 

XTDHAT(K)=XTD{ KK ) +XTDDOT (KK )*T C K ) 

EX(K  )=(  XTDKKK)-XTDHAT(K)  )  *COS(  YT(  K)  J 

XTD(K)=XTDHAT(K)+G1  (K)-*EX(K) 

XTDD0T(K)  =  CXTDD0T(KK)  +  G2(K)*EX(K)  )=?COS(YT(K)  ) 

XTD1 ( K )  =  XTDl K ) +GX( K )*  ER( K) 

XT(K)=XTD1(K)/PIRAD 

12  CONTINUE 

13  WRITE(6.51) 

DO  14  JJ=J,NSTA 
K=JSET( I ,JJ) 

14  WRITE(6,52)K,P11(K),P12(K),P22(K),GX(K),GY(K) 
WRITE(6,50) 

DO  15  JJ=J,NSTA 
K=JSET ( I.JJ) 

15  WRITE (6. 53) K.DMX(K) ,DMY(K) , TX ( K ) , ER{ K ) , XT D ( K ) , YTD ( K ) 
WRITFf  6,  56) 

WRITE(6,54) 

DO  16  JJ=J.NSTA 

K=JSET( I.JJ) 

16  WRITE(6,52)K,EP11(K),EP12(K),EP22{K),G1(K),G2(K) 
WRITE( 6,55) 

DO  17  JJ=J,NSTA 
K=JSET( I,JJ) 

17  WRITE ( 6,53) K,EX(K J ,EY(K) ,XTDDOTiK) , YTDDOT (K) ,XTD1(K), 
1YTDKK) 

C 

50  FORMAT(  //,  22X,  «K',  4X,  « DMX' ,  6X,  » DMY' ,  6X,  «TX', 
17X.  «ER5,  8X,  «XTD»,  7X,  'YTD',/) 

51  FORMAT(  //,  22X,  «K',  5X,  ,P11»,  8X,  'P12',  8X, 
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17X,     'GX'.     6X,     'GY',/) 

52  F0RMAT(20X, I3,3E11  .3,3F8.3) 

53  FORMAT ( 2 OX, 13 ,4F 9. 4 ,F1 1.4, F10. 4) 

54  FORMATt//,     22X,     'K',    4X,     • EP 1 1 • , 7X, • EP12 •  ,    7X,     'EP22', 

55  FORMATt  //,22X,«K'',  5X,'EX',  7X,'EY»,  4X , • XTDDOT' ,  3X, 
l'YTDDOT',     6X,      'XTD1',     6X,     'YTD1',/) 

56  FORMATt '1',     //////,       34X,     'EXTENDED    KALMAN    FILTER    ', 
^PARAMETERS'  .//) 

102  FORMATt  '1',  //////,  25X,  'THE  EXTENDED  KALMAN  FILTER' 
1'  IS  INITIATED  WITH  THE  ',/,  25X,  'FOLLOWING  ELLIPSE', 
2     «     FOR    CUT    NUMBER',     13,     •    OF    TARGET',     13) 

103  FORMATt//,    25X,     'THE    ANGLE    BETWEEN    THE    MAJOR    AXIS    AND' 
2«    THE    MERIDIAN',/,     25X,     'THROUGH    THE    CENTER    OF    THE    «, 
3'FLLIPSE    IS     ',     F7.3,'     DEGREES.',//,    25X,     'THE    LENGTH    0 
4'THE    SEMI-MAJOR    AXIS    IS    ',F7-3,«     DEGREES.',//,     25X, 
5'THE    LENGTH    OF     THE     SEMI-MINOR    AXIS    IS    «,F7.3,'     DEGRE' , 
6'  ES.»  ,//  ) 

RFTURN 
END 
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c 

c 

C  SUBROUTINE  PREPARE 

C 

C  SUBROUTINE  TO  ESTABLISH  THE  VECTOR  CROSS  PRODUCT 

C  MATRIX  FOR  SUBROUTINE  POSIT 

C 

C  . «.  ..c .......... 

SUBROUTINE  PREPAR  ( KI , K , SLAD , SLOD , THTD1 , THTD , TLAD , 
1TLOD) 


C 
C 


DIMENSION    SLAD( 1), SLOD( 1),ACLAT(2) ,ACL0N(2) ,THD(2) 


DATA    PIRAD/57#29578/ 

THT1=THTD1 

THT=THTD 
C 

C       DETERMINE    DIRECTION    OF    TRACK 
C 

DELLAD=SLAD(K)     -SLAD(KI) 

DELLON=SLOD(K)     -SLOD(KI) 

IF(DELLAD.E0.0 .0 .AND. DELLON . EQ .0  .0 )     GO    TO    37 

TRACK  =  90. -A  TAN  2  (DEL  LAD,  DELL  ON)'?  PI  RAD 

I  FCTRACK.LT. 0.0)     TRACK  =  TRACK +360. 

IF(THT. LT. TRACK. AND. THT1 .GE.TRACK)     GO    TO    37 

IF(THT1.LT. TRACK. AND. THT.GE. TRACK)    GO    TO    37 
C 

C       DETERMINE     IF    TARGET    IS    LEFT    OR    RIGHT    OF    TRACK 
C 

M=l 

N  =  2 

IF(TRACK.LE.180)    GO    TO    38 

IFtTHTl  .LT. TRACK. AND. THT1.GE. (TRACK-180. )  )  GO  TO  40 

GO  TO  39 

38  IFtTHTl. GT. TRACK. AND. THT1.LE.(TRACK+180. ) )  GO  TO  39 
GO  TO  40 

C 

C   TARGET  IS  TO  RIGHT  OF  TRACK 

C 

39  IFtTHTl. GT.270.AND.THT.LT. 90.)  THT=THT+360 . 
IF (THT.GT.270.AND.THT1.LT. 90.)  THT l=THTl+3  60. 
IFtTHTl .GT.THT )  GO  TO  37 

M  =  2 

N=l 

GO  TO  41 
C 

C       TARGET    IS    TO    LEFT    OF    TRACK 
C 

40  IFtTHTl. GT. 270. AND. THT. LT. 90. )     THT=THT+360. 
IFtTHT. GT.270.AND.THT1.LT. 90.)     THTl=THTl+360. 
IFCTHT.GT.THT1 )     GO    TO    37 

41  ACLAT(M)=SLAD(  KI ) 
ACLAT(N)=SLAD(  K) 
ACLONt M) =SLOD( KI ) 
ACLONtN )=SLOD(  K) 
THD(M)=THT1 
THD(N)=THT 

CALL    POSIT(ACLAT,ACLON,THD,TLAD,TLOD) 
RETURN 

r. 

C       BEARINGS    DO    NOT    CROSS    SO    NO    SOLUTION    IS    COMPUTED 
C 
37  TLAD=0.0 

TLOD=0.0 
RETURN 


C 


END 
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c 
c 
c 
c 
c 
c 
c 
c 
c 
c 
c 
c 
c 
c 
c 
c 


SUBROUTINE  POSIT  (SLA,  SLO,  THETA,  TLA,  TLO) 

SUBROUTINE  TO  COMPUTE  TARGET  POSITION  COORDINATES 
USING  VECTOR  METHODS 

DESCRIPTION  OF  CALLING  ARGUMENTS 

SLA    -  AIRCRAFT  LATITUDE 

SLA    -  AIRCRAFT  LONGITUDE 

THETA  -  BEARING  ANG LE S-GF-ARRI VAL 

TLA    -  TARGET  LATITUDE 

TLO    -  TARGET  LONGITUDE 


C 

c 


c 

c 
c 


c 
c 
c 


c 
c 
c 


c 
c 
c 


SUBROUTINE  POSIT  (SLA,  SLO,  THETA,  TLA,  TLO) 

DIMENSION  A(2),B(2),C(2),SLA(2),SL0(2),THETA(2) 

DATA    PIRAD/57. 29578/ 

DO    1     1=1,2 

PH=SLA( I J/PIRAD 

TH=SLO( I )/PIRAD 

OB=THETA(I J/PI RAD 

ST=SIN(TH) 

CT=COS(TH) 

SP=SIN(PH) 

CP=COS( PH) 

CO=COS(OB) 

SO=SIN(OB) 

COMPUTE  NORMAL  TD  BEARING  PLANE 

DX=-SP*CO»CT-ST*SO 
DY=SO*CT-SP«  CD'?  ST 
DZ=CP*CO 

COMPUTE    BEARING    VECTORS 

X1=CP*CT 
Y1=CP*ST 
AA=Y1*DZ-SP*DY 

BB  =  SP^DX-Xr  DZ 
CC=X1*DY-Y1*  DX 
D=SORT(AA**2+BB**2+CC**2) 

A(I)=AA/D 
B(  I  )=BB/D 
C(I)=CC/D 

..    CONTINUE 

COMPUTE    TARGET    POSITION    VECTOR    IN     (X,Y,Z)     COORDINATES 

X1  =  B(1  )#C(2)-C(1  )*B(2) 
X2=C(1)£A(2)-A(1)*C(2) 

X3=A(  l)-:-B(2)-B  (  1  )*"A(2) 

D=SORT  (  Xl*-:  2+X2=?~' -2+X3**2  ) 

X1=X1/D 

X2  =  X?./D 

X3=X3/D 

COMPUTE    TARGET    POSITION    VECTOR    IN     {0,0)     COORDINATES 

TLO=ATAN2(  X2,X1K  PI  RAD 

TLA=ATAN2(  X3,S  ORT  (  Xl^'*2+X2*?!*2  )  KPIRAD 

RETURN 
END 
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^E  POI  NTS 

MP  TO    LOCATE    THE    INTERSECTION    OF    THE    CONES    OF 
SOCIATED    WITH    EACH    DF    BEARING    AND    DESCRIBED    BY 
RIANCE    MATRICES    OF    THE    ANGLE    FILTER    AND    THE 
G  FILTER 


\iE  POINTS(  I  ,J,  SIGMA,RCUT,D11,HDGD,  J  SET,  PI  1, 
],THTDltTHTD.PTLAT,PTLONf  JDIMt*) 

i  ACL AT ( 2) , ACLON(2) , Dll(l) ,HDGD( 1 )  ,  JSET( JDI M, 
,PTLAT(4,  JDIM,l),PTLON(4,JDIM,  1  ),  SLAD(  1)  , 
fHD(2)  ,THTD1(  1)  ,THTD(1) 

\D/57. 29578/ 

J) 
)1(K) 

;ki 

.ge.3.-'rcut)   go  to  5 

abs(dikk)  )  >*sigma 
'ikk)  )  -'sigma 

102) 

1101)    K.THT.P11  (Kl.Pl.THTl.DlHK)  ,D1 

iURE  THAT  THE  TWO  BEARING  LINES  DO  NOT 
r  THE  SAME  POINT 

1,1) 

LAD(K)  -SLAD(KI) 
np(K)  -^LQDf  K.T  ) 
i.EQ.O.O.AND.DELLCN.EQ.O.O)  GO  TO  6 

SUBSCRIPTS    SUCH    THAT    PTLAT(l),     PTLON(l)    IS 
HE  FLIGHT    PATH    THAN    PTL  AT  {  2  )  ,  PTLON  (  2)  . 


LE.HDGD(K)  )     GO    TO    1 


=SLAD(  KI) 
SLOD(KI  ) 

=SLAD(K) 
=SLOD(K) 


.LE.1.  )     GO    TO    4 

EDGES    OF    THE    ERROR    ELL  IP  SES    DO    NOT    CROSS,    SO 
GREATER    THAN    1,    REDUCE     IT    TO    1     AND    COMPUTE 
SECTION    POINT. 


104) 

3F   INTERSECTION    OF    THTDL 


Dl    WITH   THTD    +    PI 


HT1-D1 

HT+Pl 

!.LE.THD(2)  .AND.M.EO.l)    GO    TO    2 

).LE.THD(1)  .AND.M.EQ.2)     GO    TO    2 

IT!ACLAT,ACLON,THD,TLAT,TLON) 

I.J)=TLAT 

i.J)=TLON 

3F   INTERSECTION    OF    THTD1    +    Dl    WITH    THTD    -    PI 
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t 
»/ 


THD(l) =THT1+D1 

THD(2)=THT-P1 

IF(THD(1).LE.THD(2)  .AND.M.EO.l)  GO  TO  2 

IF(THD(  2).LE.THD(1)  .AND.M.EQ.2)  GO  TO  2 

CALL  POS IT ( ACL  AT , ACLON  ,  THD , TLAT ,  TLON ) 

PTLAT(N,I, J)=TLAT 

PTLC)N(N,I,J)=TLON 
C 

C       FIND    POINT    OF    INTERSECTION    OF    THTD1    -    Dl    WITH    THTD   -    PI 
C 

THD(1)  =  THT1-D1 

THD(2)=THT-P1 

CALL  POSIT( ACL  AT,  ACLON, THD, TLAT, TLON) 

PTLAT(3,I,J)=TLAT 

PTL0N(3,I.J)=TL0N 
C 

C   FIND  POINT  OF  INTERSECTION  OF  THTD1  +  Dl  WITH  THTD  +  PI 
C 

THD( 1) =THT1+D1 

THD(2)=THT+P1 

CALL    POSIT (ACL  AT, ACLON.THD, TLAT, TLON) 

PTLAT(4, I,J)=TLAT 

PTLON14,  I, J)=TLON 

RETURN 
C 

4  WRITE(6.105) 
RETURN    1 

5  WRITE(6,103)    P11(K),I,J 
RFTURN    1 

6  WRITE(6,106)     I 
RETURN    1 

C 

101  FORMAT(  I5.6F12.4) 

102  FORMAT  CI',     /,    4X,      'K',     5X,     'THTD(K)',    6X,     'P1KKJ', 
18X,     »P1«,    6X,     "THTDKKJ  •  ,6X,     'Oll(K)',    8X,     «     Dl',     /) 

103  F0RMAT(//,5X,  'THE  ERROR  COVARIANCE  IS  ',  F12.4,  •  .• 
1'        A    SOLUTION    WOULD    BE    MEANINGLESS.       I«'fI3t(    J  =  ',I3,, 

104  FORMAT(/,    •  SIGMA=1.',/) 

105  FORMAT!//,  5X.  'THE  TWO  OUTSIDE  BEARINGS  DO  NOT  ', 
l'CROSS,  SO  NO  SOLUTION  IS  POSSIBLE.',//) 

106  FORMATt//,  5X,  'THE  BEGINNING  AND  END  OF  THE  TRACK  ', 
l'CORRELATED  WITH  TRAGET  ',12,  '  COINCIDE,  SO  NO  SOL', 
2'UTION  IS  POSSIBLE',//) 

RETURN 
END 
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c  

c 

C  SUBROUTINE  PIC 

C 

C  SUBROUTINE  TO  PLOT  THE  DF  CUTS.  ERROR  ELLIPSES 

C  COMPUTED  FROM  THE  ANGLE  FILTER  AND  THE  ERROR  ELLIPSES 

C  DESCRIBED  BY  THE  COVARIANCE  MATRIX  OF  THE  EXTENDED 

C  KALMAN  FILTER 

C 

C  MODES 

C 

C  IFLAG=1       PLOTS    THE    DF    CUTS    CORRELATED    TO    TARGET    I 

C  IFLAG=2       PLOTS    THE    ERROR    ELLIPSE    DESCRIBED    BY    THE    Pll 

C  AND    Dll    TERMS    FROM    THE    ANGLE    FILTERING    ROUTINE 

C  ASSOCIATED    WITH    CUT    J    OF    TARGET     I 

C 

C  THIS  SUBROUTIME  FIRST  DETERMINES  THE  MAJOR  DIRECTION 

C  OF  THE  PLOT,  PLOTS  IT  THE  MAJOR  DIRECTION  OF  THE  PLOT 

C  USING  A  MERCATOR  PROJECTION 

C 

C 

SUBROUTINE    PIC (I  FLAG, I ♦ J J ,N ST, J SET, SLAD , S LOD, TLAD, 
1TL0D,THETA,THTD,THTD1,P11,D11,HDGD,RCUT, JDIM,PTLAT, 
2PTL0N,SIGMA,P12,P2  2,XTD1,YTD1) 
C 

DIMENSION    ACLAT(100),ACL0N(100),A(4),B(4),  DlKUi 
1FLAD( 100) ,F LOD (100)  ,HDGD(1)  ,  IT1Q2) ,IT2(12  ),IT3(12). 
2IT4C13),  JSETUDIM,  1),NST(1)  ,  NUMB  (25)  ,PTL  AT(  4,  JD  I  M  ,  1 )  , 
3PTL0N(4,  JDTM,1)  ,  Pll  (1)  ,  SLAD(  1  )  ,  SLOD(  1  ),THETA(  1), 
4TLAD(1) ,TL0D(1) .THTDC1) ,THTD1(1) , XX ( 101 ) , X Z( 101 ) , 
5YY(101),P12(1),P22(  D.XTDKl).  YTDK1J  ,  IT5(  13) 
C 

DATA    ITl/'PLOT    OF    DF    CUTS    AND    A/C    NAVIGATION    DATA    •/ 
DATA    IT2/'  EDWARD    H.    MILLS  •/ 

DATA    IT3/«  NTAR    =  '/ 

DATA    IT4/'PL0T«,«    OF    '.'ERRC'R    CO  »  ,  ■  VARI  •  , «  ANCE  •  , 
1«S    OF','     SMO», 'OTHE', 'D    BE • , • AR IN • , ' G    LI'.'NES    '/ 

DATA    ITS/'PLOT'.1     OF    • , « ERRO' , ' R    CO' ,' VARI ',' ANCE' , 
l'S    OF','     EXT',  'ENDE'.'D    KA'.'LMAN','     FIL'^TER    «/ 

DATA    NUMB/'  1  •  .  •  2  •  ,  '  3«  ,  '4  •  ,  •  5  •  ,  ■  6«  ♦  '  7'  ,  •  8  •  ,  ■■  9*  ,  •  10  •  , 
I'll'.' 12','13« ,' 14' ,•15•,•16,,•17, .'IS' .'lg' ,'20' , 
2'21«, '221, '231 , '24', '25'/ 

DATA  PIRAD/57. 29578/ 

NSTA=NST(I ) 

IFUFLAG.EQ.l)  JJ  =  NSTA 
DO  1  J=1,NSTA 
K=JSET( I ,J) 
ACLAT( J)=SLAD( K) 
1     ACLON( J)=SLOD(K) 

IFUFLAG.EQ.2)  GO  TO  9 

IF(  IFLAG.E0.3)  GO  TO  41 

A(1)=TLAD(  I) 

B(1)=TL0D(I) 

ALATS=SMALL2(ACLAT,NSTA,A,1) 

ALATH=HUGE2(ACLAT,NSTA,A,1) 

AL0NS=SMALL2(ACL0N,NSTA,B,1) 

AL0NH=HUGE2(ACL0N,NSTA,B, 1) 

GO    TO    12 

CALLSP0INTS?I, JJ,S?GMA?RCUT,D11,HDGD,JSET,P11,SLAD, 
1 SL0D.THTD1.THTD.PTL AT tPTLONtJDIM, 61000) 
DO    10    N=l,4 
XX(N)=PTLON(N, I,JJ ) 
10         YY(N)  =  PTLAT(N,I  ,JJ) 
GO    TO    42 

41  CALLEELIPS7(P11{K)  ,  P12  (  K)  ,  P22  (  K)  ,XTD1  (  K)  ,  YTD1  (K)  ,  XX, 

1YY) 


C 
C 
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42 


C 
C 
C 
C 


N=101 

AL0NS=SMALL2(ACL0N,NSTA,XX,N) 
AL0NH=HUGE2(ACLCN,NSTA,XX,N) 
ALATS=SMALL2 ( ACL  AT , NST A , YY , N ) 
ALATH=HUGE2(ACLAT,NSTA,YY,N) 


ADAD=AIRCRAFT 
ADOD=AIRCRAFT 


POSITION    LATITUDE    VARIATION     IN    DEGREES 
POSITION    LONGITUDE    VARIATION    IN    DEGREES 


12 


C 
C 
C 
C 
C 
C 
C 
C 


C 
C 
f 

c 
c 


c 
c 

c 


c 
c 
c 


c 
c 
c 


c 
c 


ADAD=ABS(ALATH-ALATS) 

ADOD=ABS(ALONH-ALONS) 

ASLAR=( (ALATH+ALATSJ/2. J/PIRAD 

CSLA=COS(ASLAR) 

ADAD2=. 7  5-<ADAD 

IF(ADOD.GT.ADAD2)    GO    TO 


21 


ADAD  IS  GREATER  THAN  ADOD 


PROGRAM  TO  SCALE 
LONGITUDE  ONLY 


DATA  FOR  NORTH  LATITUDE  AND  WEST 


COMPUTE  X  AND  Y   SCALE  INCREMENT  VALUES  DX  AND  DY 

DX=1. 

IF(ADAD.GT.8)     DX=ADAD/8. 
IFUD0D.GT.6)     DX=AD0D/6. 
IF(AD0D.LE.3.AND.ADAD.LE.4)     DX= .5 
IF ( ADOD. LE. 1.5. AND. ADAD. LE. 2)     DY=.25 
DY=DX 


INITIAL    VALUES    XMIN    AND    YMIN 
IN    DEGREES 


COMPUTE    X    AND    Y    AXIS 

LONGITUDE    IS    WEST(-) 

ABSC=0.0 
MIN=ALONS-(DX+.5) 

XMIN=MIN 

LATITUDE     IS    NORTH(+)     IN    DEGREES 

ORD=90.0 

MIN=ALATS-(DY+-.5 ) 
YMIN=MIN 

DRAW    AXIS 

XORIG=0.0 
YORIG=0.0 
CDIV=1 

SDIV=CSLA 
LA  =  1 
.     LB  =  2 
LC  =  -7 

IT3(7)=NUMB( I) 

CALL    PLOTS 

CALL    PL0T(-3., 0..-3) 

CALL    PLQK1..0  ..-3  )    ■ 

CALL    AXISC XORIG.YORIG, 'DEGREES    LONGITUDE' ,-17, 6 . 0, 
1ABSC,XMIN,DX*CDIV,  SDIV) 

CALL    AXIS(X0R1G,Y0RIG, 'DEGREES    LAT ITUDE • , - 16, 8. , ORD, 
1  YMIN,  DY.CDIV,  SDIV) 

CALL    SYMBOL (0.0, 14.0,0.21, IT 2, 0.0, 40) 

CALL    SYMB0L(0.0,13.5,0.21,IT3,0.0,40) 

SCALE    DATA 

DY=DX*CSLA 

DO    2    N=1,NSTA 
XX(N)=(ACLCN(N)-XMIN)/DX 
YY(N)=(ACLAT(N)-YMIN) /DY 

DRAW    NAV    TRACK 
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c 

c 


c 
c 
c 


c 
c 
c 
c 
c 
c 


3 

13 

4 


c 
c 
c 


CALL    LINECXX,YY,NSTA,LA,LB) 

IF( IFLAG.EQ.2)     GO    TO    5 

IF( IFLAG.FQ.3)     GO    TO    43 

CALL    SYMBOL (O.0, 14. 5, 0.21,  IT 1,0. 0,40) 

PLOT    DF    CUTS    TO    FORM    THEORETICAL    EMMITTER    LOCATION 

DO    4    J=1,NSTA 

DT=0.0 

K=JSET( I ,J) 

CTH=COS(THETA( KJ ) 

STH=SIN(THETA(K)  ) 

DO    3    L=1,1C0 

LL  =  L 

FLAD(L)=YY(J  J  +  DT*CTH 

FLOD(L) =XX( J J+DT-STH 

IF(FLAD(L) .GT. 8     .OR .FLADC L ) . LT . 0 )    GO    TO    13 

IF(FL0DCL1.GT.6.    OR.    FLO  DC L ) . LT . 0 )     GO    TO    13 

DT  =  .07>:  L 

CONTINUE 

CALL    LINEl FLCD, FLAD.LL , L A, LC ) 

CONTINUE 

SUBROUTINE    TO    PLOT    SMOOTHED    INITIAL    BEARING    LINE    AND 
KALMAN    FILTERED    FINAL    BEARING    LINE 

SMOOTHED    INITIAL     BEARING    LINE     CTHTD1) 

KI  =  JSET(  I, 1) 
KF=JSET { I,NSTA) 
THT1=THTD1CKFJ  /PIRAD 
FX  =  XX(  1  1+8. :■  SINCTHT1) 
FY=YY(1  )+8.-'C0S(THTl) 

r*  \j  _  v/  w  /     i     | 
^  A—  AAA    J.  J 

SY=YYC 1  ) 

CALL    PL0T(SX,SY,3) 
CALL    PL0T(FX,FY,2) 

KALMAN  FILTERED  FINAL  BEARING  LINE  (THTD) 

THTF=THTD(KF)/PIRAD 

FY=YY(NSTA)+8.*C0S(THTF) 

FX=XX(NSTA)+8.*SIN( THTF) 

SX=XX(NSTA) 

SY=YY(NSTA) 

CALL    PLOT(SX,SY, 3) 

CALL    PL0TCFX,FY,2) 


C 

c 
c 
c 


GO    TO    8 

PLOT    THE    ELLIPSE 
ERROR    COVARIANCE 


FORMED    BY 
MATRICES. 


THE    Pll    TERMS    OF    THE 


IT4,0.0,52) 


14,FL00T,90.,-1) 


11 

20 
6 


C 
C 
C 


CALL    SYMBOLCO.O,  15.0,  0.21 
FLOOT=JJ 

CALL    NUMBER(5.25,     7, 
KI=JSET(  I,  1) 
K  =  JSET(  I,JJ J 
DO    11    N=l,4 
XX(N)=PTLONCN, I , JJ) 
YY(N)  =  PTLAT(N,  I, JJ  ) 

CALL    ELIPS6(KI ,K,SLAD,SL0D,THTD1(K),THTD(K),D11(K), 
1P11(K),XX, YY.Alf Bl« ALPHA1,TLAD(  I  )  ,TLOD(  I  ) ) 
DO    6    K=1.101 
XX(K)  =  C  XXCK)-XMIN)  /DX 
YY(K)= (YY(K)-YMIN) /DY 
CALL    LINE(XX,YY, 101,1,  1) 

PLOT    THE    FILTERED    FIRST    AND    CURRENT    FINAL    CUTS. 
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c 
c 
c 
c 


K=JSET( I tJ 
THT1=THTD1 
SX=(ACLAT( 
SY  =  (  ACLON( 
FX=SX  +  8.'iC 
FY  =  SY+8.'"S 
CALL  PLOT( 
CALL  PLOT( 
THT=THTD(K 
SX=(ACLAT( 
SY=(ACLCN{ 
FX=SX+8.K-C 
FY=SY+8.-:  S 
CALL  PLOTt 
CALL  PLQT( 

GO  TO  8 


J) 

(IO/PIRAD 
1)-XMIN)/DX 
1)-YMI  N)  /DY 
OS(THTl) 
IN(THTl) 
SX.SY,  3) 
FX,  FY, 2) 
)  /PI  RAD 
JJ-XMIN) /DX 
J  )  -Y  M I  N  )  /  DY 
QS(THT) 
IN(THT) 
SX.SY, 3) 
FX,FY,2) 


PLOT  THE  ELLIPSE 
OF  THE  EXTENDED 


FORMED  BY  THE 
KALMAN  FILTER. 


;rror  covariance  terms 


43 


0 


44 


CALL  SYMBOL (0 
FLOOT=JJ 

CALL    NUMBER(5.25, 
K=JSET  (  I.JJ) 
CALL    ELI PS7(P11 (K) 
1YY) 
DO    44    K=l,  101 
XX(KJ=(XX(K)-XMIN)/DX 
YY(K)=( YY(K)-YMIN) /DY 
CALL    LINEtXX.YY, 101,1 


15.0,  0.21,  IT5, 0.0, 52) 
,  7. ,. 14,FL00T,90.,-1) 

PI  2 (K),P22(K),XTD1(K),YTD1(K),XX, 


1) 


C 
C 
C 


CALL  PLOTC-3. . 18. ,-3) 
CALL  PLOT(1.75,0.,-3) 
CALL  PLOTE 
RETURN 

3    DY=1. 

ADOD    IS    GREATER    THAN    ADAD 

IF(AD0D.GE.8)     DY=AD0D/8. 

IF(ADAD.GT.o)     DY=ADAD/6. 

IF(AD0D.LE.4.AND.ACAD.LE.3.)     DY=.5 

IF( ADOD. LE.2.AND. ADAD. LE. 1.5)    DY=.25 
LONGITUDE     IS    WEST(-)     IN    DEGREES 

DX  =  DY 

ABSC=90.0 

MIN=ALONS-(DY+.5) 

YMIN=MIN 

IF(DY.LT.( .5) )     YMIN=ALONS-DY 
LATITUDE     IS    NORTH(  +  )     IN    DEGREES 

ORD=0.0 

MIN=ALATS-.5 

XMIN=MIN 

IF(ABS( XMIN-ALATS) .GT..9)  XMIN=XMIN+1. 

IF(DX.LT.( .5) )  XMIN=ALATS 

XMAX=XMIN+5.*DX 

DX=-DX 


c 

c 

DRAW    AXIS 

c 

XORIG=0.0 

Y0RIG=0.0 

CDIV=CSLA 

SDIV=1. 

LA  =  1 

LB=2 

LC=-7 

IT3(7) =NUMB(I) 

CALL    PLOTS 

CALL    PLOTC-3., 0 

-3) 
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CALL    PLOT(2..0.,-3) 

CALL    AXISl  XORICYORIG,  'DEGREES    LATI TUDE ' ,-16 ,6. 0 , ORD, 
1XMAX.  DX»CDIV,SDIV) 

CALL    AXI  S(  XORICYORIG, 'DEGREES    LONGITUDE' , -1 7 , 8 .0 , 
1ABSC,YMIN,DY,CDIV,SDIV) 

CALL    PLCT(X0RIG,Y0RIG,3) 

CALL     PLOT( 0.0, Y0RIG,2) 

CALL    PLOT (0.0,0.0, 2) 

CALL    SYMBOL (0.0, 14.0,0.21, I T2, 0.0, 40) 

CALL    SYMBOL (0. 0,13.5,0.21,IT3,0.0,40) 

CALL    PLOT(XORIG,0.,-3) 
C 

C         SCALE    DATA 
C 

DX=DX5CSLA 

DO    22    N=1,NSTA 

XX(N)=(ACLAT(N)-XMIN)/DX 
22  YY(N)=(  ACLON(N)-YMI  N) /DY 

C 
C  DRAW    NAV    TRACK 


C 


CALL    LINE(XX,YY,NSTA,LA,LB) 


IF(  IFLAG.E0.2)     GO    TO    27 

IF( IFLAG.E0.3)     GO    TO    45 
'     0RIGX=X0RIG-.75 

0RIGY=Y0RIG+.3 

CALL    SYMBOL (-OR  I GX, ORIGY, . 14, IT  1 , 0 . , 40 ) 

FLOOT=I 

CALL  NUMBER (-.75, 7. , . 14, FLOOT , 90. ,-1) 
C 

C    PLOT  DF  CUTS  TO  FORM  THEORETICAL  EMMITTER  LOCATION 
C 

DO  26  J=1,NSTA 

DT=0.0 

K=JSET£  I.J  J 

CTH=COS(THETA(K)  } 

STH=SIN( THETA( K) ) 

DO  23  L=l.  100 

LL  =  L 

FLAD(L  )=XX( J)-DT*CTH 

FLOD(L)=YY(J)  +  DT-:-STH 

IF( FLAD( L) .GT.O.OR. FLAD(L) .LT.-6)  GO  TO  24 

IF(FLOD(LJ .GT.  8.  OR.  F LOD ( L ) . LT . 0 )  GO  TO  24 

DT  =  .07*L 

23  CONTINUE 

24  CALL  LINEtFLAD , F LOD , LL , L A , LC ) 
26    CONTINUE 

C 

C    SUBROUTINE  TO  PLOT  SMOOTHED  INITIAL  BEARING  LINE  AND 

C    KALMAN  FILTERED  FINAL  BEARING  LINE 

C 

C    SMOOTHED  INITIAL  BEARING  LINE  CTHTD1) 

C 

KF=JSET(I,NSTA) 

THT1  =  THTD1(KFJ  /PI  RAD 

FX=XX(  1  )-8.v  COS(THTl) 

FY=YY( 1)+8.*SIN(THT1) 

SX=XX( 1) 

SY=YY(1  ) 

CALL  PL0T(SX,SY,3) 

CALL  PLOT(FX.FY, 2) 

WRITE(6,101)  SX,SY 
C 

C    KALMAN  FILTERED  FINAL  BEARING  LINE  (THTD) 
C 


THTF=THTD( KFJ/PIRAD 

FX=XX(NSTA)-8." COS(THTF) 

FY=YY(NSTA)  +  8."'SIN(THTF) 

SX  =  XX(NSTA) 

SY=YY(NSTA) 

CALL  PL0T(SX,SY,3) 
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c 
c 
c 
c 


CALL  PL0T(FX,FY,2) 
WRITE(6,101)  SX,SY 
GO    TO    30 

PLOT    THE    ELLIPSE     FORMED    BY 
ERROR    COVARIANCE     MATRICES. 


THE    Pll    TERMS    OF    THE 


27 


0RIGY,0.14,IT4,0.,52) 
,0.14,FL00T,90.,-1) 


40 


29 


C 
C 
C 


0RIGY=Y0RIG+.3 
CALL  SYMBOLt-XORIG 
FLOOT=JJ 

CALL  NUMBER(-.75,7 
KI=JSET( I.l) 
K=JSET( I,JJ ) 
DO  40  N  =  1.4 
XX(N) =PTLON(N,  I  , JJ) 
YY(N)=PTLAT(N,  I,  JJ) 

CALL    ELIPS6(KI , K  ,  S L AD, S LOD, THT D 1 ( K ) , THTD ( K ) 
1P11(K),XX,YY,A1,B1 ,ALPHA1,TLAD( I) ,TLOD( I ) ) 
WRITE  (6,  101)(XX(J)  .  YY{  J),  J  =  1,10) 
WRITE(6.101)     XMIN,YMIN 
DO    29    J=l,101 
XZ(J)=(YY( J)-XMIN)/DX 
YY( J)  =  ( XX ( JJ-YMIN) /DY 
WRITEC6, 101) (XZ( J) ,YY( 
CALL    LINE(XZ,YY, 101,1. 


Dll(K) 


J)    ,J: 
1) 


•1,10) 


PLOT    THE    FILTERED    FIRST    AND    CURRENT    FINAL    CUTS, 


C 
C 

c 
c 


THT1=THTD1 
SX=(ACLAT( 
SY=(ACLONt 
FX=SX-7. 'C 
FY=SY+7o='  S 
CALL  PLOT( 
CALL  PLOT( 
THT=THTD(K 
WRITE(6,10 
SX=(ACLAT( 
SY=(ACLON( 
FX=SX-7.rC 
FY=SY+7.;:  S 
CALL  PLOTC 
CALL  PLOT( 
GO    TO    30 


(KJ/PIRAD 

D-XMIN)  /DX 

1  )  -Y  M  I  N  )  /  DY 

OS(THTl) 

IN  (THTD 

SX,SY,3) 

FX,FY,2) 

)  /  P I  R  A  D 

0!    K,THT 

JJJ-XMIN) /DX 

JJ1-YMINJ/DY 

OS(THT) 

IN(THT) 

SX,SY,3) 

FX,FY,2) 


C 

c 
c 


PLOT  THE  ELLIPSE  FORMED  BY  THE  ERROR  COVARIANCE  TERMS 
OF  THE  EXTENDED  KALMAN  FILTER. 

45    0RIGY=Y0RIG+.3 

CALL  SYM3OL(-X0RIG,ORIGY,0. 14,IT5,0.,52) 
FLOOT=JJ 

CALL  NUMBER(-.75,  7.  ,. 14 , F LOOT , 90 . ,-1 ) 
K=JSET(I,JJ) 

CALL  ELI  PS7(  Pll(K)  ,P12  (  K )  ,  P22  (  K  ) ,  XTD1  (  K  )  ,  YTD1  (  K  )  ,  XX, 
1YY) 
DO  46  J=l,  101 
XZ(J)=(YY( J)-XMIN)/DX 
YY(J)=( XX( JJ-YMIN) /DY 
CALL  LINE(XZ,YY, 101,1,  1) 

MARK  THE  KNOWN  POSITION  OF  THE  TARGET 


46 

!       I 
'30 

36 
37 


IF(I.GT.2)     GO    TO    47 
IFII.E0.2J     GO     TO    36 
ATLAD=33 .24055 
ATL0N=-117.4169 
GO    TO    37 
ATLAD=32. 78222 
ATL0N=-117.2244 
SX1=( ATLAD-XMINJ/DX 
SY1=( ATLON-YMIN)/DY 
SX=SX1-1. 
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47 


100 
101 
102 
105 
1000 


c 
c 
c 
c 
c 
c 
c 
c 
c 
c 


FX=SX1+1. 

SY=SY1-1. 
FY=SY1+1. 

CALL  PL0T(SX,SY1,3) 
CALL  PL0T!FX,SY1 ,2) 
CALL  PL0TCSX1. SY,3) 
CALL  PLOTfSXl.  FY, 2  ) 
CALL  PLOK-12.  ,18.  ,-3) 
CALL  PLQT( 1.75,0. ,-3) 
CALL  PLOTE 
FORMAT! I5,2F12.6) 
FORMAT! 2F12.6, /) 
FORMAT! • l1 , 13) 
FORMAT! 2F12.3.3I 5) 
RETURN 
END 


SUBROUTINE  AXIS 

SUBROUTINE  TO  COMPUTE, 
MERCATOR  PROJECTION  IN 


DRAW  AND  LABEL 
THE  NORTH  WEST 


THE  AXES  FOR 
HEMISPHERE 


20 


22 
24 


25 


SUBROUTINE    AXIS     (X  B  ,  YB  ,  BCD,  NC,  S  I  ZE,  THETA  ,  YM  IN  ,  DY  ,  CDIV  , 
1SDIV) 
DIMENSION    BCD!  1) 
ZING  =  1, 
IF(NC)  1, 
ZING    = 
NAC  =  IAB! 


TH=THE' 
CTH=COS 
STH=SIN 
N    =    SIZ 
IFfTHET 
IF!THET 
TN  =  N 
X  =  XB 
Y=YB 
XA    =    X 
YA    =    Y 
CALL    PL 
DO    20     I 
CALL    PL 
XC=XB    + 
YC=YB+S 
CALL    PL 
XA=XA+C 
YA=YA    + 
CALL    PL 
XB=XC 
YB=YC 
YA  =  Y-0. 
IF(ABS( 
IF!A3S( 
IF(THET 
IFfTHET 
XA  =  X    + 
GO    TO    2 
XA=X-.2 
IF!ABS! 
IFfABS! 
WRITE!6 
ABSV=YM 
DO    30     I 
CALL    NU 
ABSV=AB 


ON 
0 

,2, 
-1. 

S  (N 

A-:  . 

CTH 
(TH 
E+0 

A.E 
A.E 


2 

0 
C) 

01 

)/ 
)/ 

.5 
0. 
0. 


74533 

CDIV 

SDIV 

0 

90.AND.CDIV.E0.1 )    N=S I Z E^SDI V 

0.  AND.  SDIV.  EO.  1)     N  =  SIZE*>CDIV 


-    0.1    *    ZING 
+    0.1    fr     ZING 
OT    !XA,YA,3) 
=  1,N 
OT    !XB.YB,2) 

CTH 
TH 

OT     (XCYC2) 
TH 

0T(XA,YA,2) 


STH 
CTH 


250 

YMI 

YMI 

A.E 

A.E 

0.2 

5 

50 

YMI 

YMI 

,61 

IN 

=  1, 

MBE 

SV+ 


N)  .GE.100.  )YA=Y-.375 

N) .GE.  100.  AND.YMIN.LT. 0.0)    YA  =  Y-.50 

0.90.0)     GO    TO    22 
0.0.0)GO    TO    24 
50 


N) .GE.100.)XA=X-.375 

NJ .GE.100. A ND.YMIN.LT. 0.0)     XA=X-.50 

)XA,  YA 

N 

R!XA,YA,0.14,ABSV,THETA,2) 

DY 
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XA=XA+CTH 

YA=YA+STH 

30 

CONTINUE 

TNC=NAC+7 

CTH=CTH'-:  CD  IV 

sth=sth; sdi v 

XA=X+(SIZE    /2. 

YA=Y+(SIZE    /2. 

CALL    SYHBOUXA 

WRITE(6,62  )XB, 

60 

FORMATPO          AB 

61 

FORMAT ( ' 0       XA= 

62 

FORMAT (/,3X, 'X 

50 

RETURN 

END 

0-.06   -"TNCJfcCTH    -    (-.07    + 

0-.06    *TNC)*STH    +    (-.07    + 

,YA,0.14,BCD,THETA,NAC) 

YB 

SV  =  '  ,  F10.5) 

• , F10.5,'       YA=',F10.5) 

B=',F10.5,2X, ,YB=',F10.5, /) 


ZING*. 42)*     STH 
ZING'-.42J»"     CTH 


FUNCTION    SMALL2(A,NSTA,B,N) 

DIMENSION    A(50),B(50) 

SMALL2=A(1 ) 

DO     1    I=2,NSTA 

IF(SMALL2.LE.A( I ) )     GO    TO    1 

SMALL2=A(I  ) 

CONTINUE 

DO    2    I  =  1.N 

IF(SMALL2.LE.B( I ) )     GO    TO    2 

SMALL2=B(I  ) 

CONT  INUE 

RETURN 

END 


FUNCTION    HUGE2 (A,NSTA, B,N) 
DIMENSION    A(50) ,B(50) 
HUGE  2=  A  (  1) 

=2,NSTA 

GE.Al I  )  ) 


DO    1     I 
IF(  HUGE2 
HUGE2=A( I ) 
CONTINUE 
DO    2    I=1,N 
IF(HUGE2 
HUGE  2  =  BID 
CONT INUE 
RETURN 
END 


GO    TO    1 


GE.B(  I )  )    GO    TO    2 
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c      „ 

c 

C      SUBROUTINE  ELI PS6 
C 

C      SUBROUTINE  TO  DESCRIBE  AN  ELLIPSE  TO  FIT  THE  FOUR 

C      POINTS  COMPUTED  IN  SUBROUTINE  POINTS 

C 

C c 

SUBROUTINE    ELI PS6(KI  , KC , SLAD , S LOD ,THT Dl , THTD, Dl 1 , PI  1 , 
1X3,  Y  3,  Al,  Bl.  ALPHA  1,  T LAD, TLOD) 
C 

DIMFNSION    SLAD( 1) , SLQDC1) .X(101) ,X3(101) tY(lOl) t 
1Y3(101 ),Z(4) 


C 
C 


C 


DATA    PIRAD/57. 29578/ 

CALL    PREPAR     (K I , KC , SLAD, SLOD,THTDl, THTD , TL AD, TLOD ) 


C 

C   TLAD,  TLOD  IS  THE  CURRENT  ESTIMATE  OF  THE  TARGET 

C   POSITION. 

C 

C       X3.Y3    ARE    THE    LOCATIONS    OF    THE    INTERSECTIONS    OF    THE 

C       EDGES    OF    THE    TWO    ERROR    CONES. 

C 

DELX  =  X3(  1)-X3(  2) 

DELY=Y3(1)-Y3(2) 

ALPHA 1=ATAN2(DELX,DELY) 

ALPHA2  =  ALPHA  1-1. 57 37963 

ALPHAD  =  ALPHA1*  PI  RAD 
C 

C       ALPHAD    IS    THE    ANGLE    OF    ROTATION    OF    THE    ELLIPSE 
C 

DELX=TLOD-X3(2) 

DELY=TLAD-Y3(2  ) 

A1=SQRT(DELX*«=2+DELY**2) 
C 

C       Al     IS    THE    SEMI-MAJOR    AXIS 
C 

DO    4    K  =  3,4 

DELX=TL0D-X3(K) 

DELY=TLAD-Y3(K) 

BETA  =  ATAN2(DEL  X,DELY) 

GAMMA=ALPHA2-BETA 
4  Z(  K)  =SORT(DELX?>?2  +  DELY**2)*COS(  GAMMA) 

B1=(ABS(Z(3) )+ABS(Z(4) ) )/2.0 
C 
C       Bl     IS    THE    SEMI-MINOR    AXIS 


WRITE(6,103)    ALPHAD, A1.B1 


EPS=Al/25. 

Y(1)=-A1 

Y(  101)=-A1 

AA  =  A1^>  2 

BB  =  B1?*2 

DO    1    K  =  2,51 

KK  =  K— 1 

Y(K)  =Y(KK)+EPS 

1  Y( 102-K)=Y(K) 
DO    2    K=l,51 

CC=ABS(BB*(1.-(Y{«)**2)/AA)) 
X(K)=SORT(CC) 

2  X(102-K)=-X(K) 
C 

C   ROTATE  THF  ELLIPSE  BY  ALPHAD  AND  TRANSLATE  ITS  CENTER  TO 

C       TLOD.TLAD. 

C 

CA  =  COS(  ALPHAD 

SA  =  SIN(  ALPHAD 

DO    3    K=1.101 
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X3(K)  =  X(K)-'CAH-Y(K)-'SA+TL0D 
3  Y3(K)=-X(K)<  SA+Y(K  J^CA+TLAD 

WRITE(6,101)X3(1 ) ,Y3(1 ) ,X3(50) ,Y3(50) ,X3(25) ,Y3(25), 
1X3(75) . Y3( 75) 
C 
101       F0RMAT14F12.2) 

103       FORMAT*//, 5X,'THE    ANGLE    BETWEEN    THE    MAJOR    AXIS    AND    '  , 
2'THE    MERIDIAN' ,/,5X, 'THROUGH    THE    CENTER    OF    THE    ', 
3«FLLIPSE    IS    «,F7.3,«     DEG  RE  E  S  .',//,  5X  ,'  THE    LENGTH    OF    ' 
4'THE    SEMI-MAJOR    AXIS    IS     «,F7.3,'     DEGREE S. • t // t 5X, 
5'THE    LENGTH    OF    THE    SEMI-MINOR    AXIS    IS    ',F7.3,'     DEGRE' 
6  ■  E  S  .  ■  t  /  /  ) 
RETURN 
END 
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C o  .  .  . 

c 

C      SUBROUTINE  ELIPS7 
C 

C      SUBROUTINE  TO  DESCRIBE  THE  ELLIPSE  TO  FIT  THE  ERROR 

C      COVARIANCE  TERMS  IN  THE  EXTENDED  KALMAN  FILTER 

C 


c 
c 
c 


SUBROUTINE  ELI  PS 7 ( A , C, B,TLOD, TLAD, X3, Y3 ) 
DIMENSION  X< 101) ,Y(  101), X3( 101) ,  Y3( 101) 
DATA  PIRAD/57. 29578/ 


AMIB=A-B 
IF(ABS( AMIB) .LT.1E-8)  GO  TO  10 
ALPHAD=90.-.5*ATAN2( 12.*C) ,  AMIB  )*P  IRAD 
GO  TO  11 

10  ALPHAD=0.0 

11  ALPHA1  =  ALPHAD/PIRAD 
CA=COS( ALPHA1) 
SA=SIN( ALPHA1) 

A2  =  ABS  IA*SA**2+2.*C*SA*CA+B*CA*#2) 

A1=S0RT( H2) 

B2  =  ABS(A^CA^2-2.*C^SA"VCA  +  B"SA^2) 

B1=S0RT(B2) 
C 

C       ALPHAD    IS    THE    ANGLE    OF    ROTATION    OF    THE    ELLIPSE 
C 

C       Al     IS    THE    SEMI-MAJOR    AXIS 
C 
C       Bl    IS    THE    SEMI-MINOR    AXIS 


C 


WRITE(6«103)    ALPHAD, A1.B1 


EPS=Al/25. 

Y(1)=-A1 

Y( 101)=-A1 

BB  =  B2 

AA=A2 

DO    1    K=2,51 

KK=K-1 

Y(K)  =Y(KK)+EPS 

1  Y( 102-K)=Y(K) 
DO    2    K=l,51 

CC  =  ABS(BB>:-'(l.-(Y(K)«-v2  )/AA)  ) 
X(K)=SQRT(CC) 

2  X(102-K)=-X(K) 
C 

C         ROTATE    THE    ELIPSE     SUCH    THAT    AA    IS    PARALLEL    TO    THTD1    AND 

C         TRANSLATE    TO    XZERO    AND    YZERO. 

C 

DO    3    K=1.101 

X3(K)=X(K)*CA+Y(K)*SA+TL0D 

3  Y3(K)=-X(K) i SA+Y(K)-CA+TLAD 
DO    23    K=l,  51 

23  WRITE (6, 101 ) X3 ( K ) , Y3 ( K ) ,X3 ( K+50 ) ,Y3(K+50) 

C 
101       F0RMAT(4F12.2) 

103  F0RMAT(5X,  'THE  ANGLE  BETWEEN  THE  MAJOR  AXIS  AND  THE  • 
l'MERIDIAN  THROUGH  THE  CENTER  OF  THE  ELLIPSE  IS  SF7.3, 
1«  DEGREES',/,  5X,  'THE  LENGTH  OF  THE  SEMI-MAJOR  AXIS  ' 
2'IS«,F7.3,«  DEGREES',  /,  5X,  'THE  LENGTH  OF  THE  SEMI-' 
3'MINOR    AXIS    IS',F7.3,'     DEGREES',/) 

104  FORMAT!     /. 5X , ' L ATT  I TUDE    AND    LONGITUDE    OF',     /,    3X, 
l'THTD    -t-    Pll       THTD    -Pll       THTD1    -    Dll    THTD1    + 
2'WITH    THTD1       WITH    THTD1       WITH    THTD         WITH    THTD',    /) 

RETURN 
END 
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c 
c 
c 
c 
c 
c 
c 
c 
c 
c 
c 
c 
c 
c 
c 
c 
c 
c 
c 
c 
c 
c 
c 
c 
c 
c 


SUBROUTINE  MONACO (NUM.  IX , ST DEV , STDEVN , AMEAN, KFLAG , NP UN 

SUBROUTINE  TO  READ  AIRCRAFT  DATA  AND  ADD  GAUSSIANLY 
DISTRIBUTED  RANDCM  NOISE 

LIST  OF  VARIABLES 

L  NUMBER  FOR  RANDOM  NUMBER  GENERATOR 

RD  DEVIATION  OF  NOISE  ADDED  TO  DF  BFARIN 

RD  DEVIATION  OF  NOISE  ADDED  TO  NAVIGATIO 

F  ALL  NOISE 

R  FOR  REPEATED  MONTE  CARLO  RUNS 

OF  RUNS  DESIRED  FOR  MONTE  CARLO 
TION.  MUST  BE  GREATER  THAN  OR  EQUAL  TO  2 
F  DF  BEARING  NOISE 
F  LONGITUDE  NOISE 
F  LATITUDE  NOISE 
CE  OF  BEARING  NOISE 
CE  OF  LONGITUDE  NOISE 
CE  OF  LATITUDE  NOISE 
SION  FACTOR  57.29578  DEGREES  PER  RADIAN 


IX 

INITIA 

STDEV  - 

ST  AN  DA 

STDEVN- 

STANDA 

AMEAN  - 

MEAN  0 

KFLAG  - 

COUNTE 

NRUN   - 

NUMBER 

SIMULA 

AMEANT- 

MEAN  0 

AMEANE- 

MEAN  0 

AMEANN- 

MEAN  3 

VARIT  - 

VARI AN 

VARIF  - 

VARI  AN 

VARIN  - 

VARIAN 

PI  RAD  - 

CONVER 

C 

c 
c 
c 
c 


C 
C 
C 


c 

C 

c 


c 
c 
c 


C 

c 


SUBROUTINE  MONJACO(NUM,  IX,  STDEV,  STDEVN  ,  AMEAN  ,  KFLAG  ,  NRUN 

COMMON  ACLAD(IOO) , ACL AMD ( 100) , ACL AR ( 100  J ,ACL0D(100), 
1ACL0MD( 100),ACLOR( 100) , ALT( 100) ,BRNG( 10  0) ,BRNGD(100) , 
2E(100)  , F RE  0(100), Gl (100) , G2 ( 10  0 ) , GAT E ( 100 ) ,HDG( 100), 
3HDGD( 100 ), MODE N( 100), MODET( 100)  ,NST( 100)  ,  PI  1(100) , 
4  PI  2 (100) ,P22(100 ), P  ITCHi 10  0) ,PRF(  100),PW(  100), 
5R0LL{ 10Q) ,SLA( 100) ,SLAD(100] ,SL0(100) ,SL0D(100)f 
5T ( 100 ). TIM  EN ( 100  }, TIMET (  100) ,T0TD(  100) ,THTD( 100) , 
6THTDK100)  ,  THET  A  (  100  )  ,  THET  AD  ( 100  )  ,  TL  AD(  100),TL0D(  100), 
7VEL( 100) ,VELE( 100) , VELN(IOO) ,XTD{100) ,YTD(100), 
8D1K100),  JST(IOO) 

DATA  AMEANT,AMEANE, AME ANN, VARI T, VARI E, VARI N/0., 0.,0. , 
10..0..0./ 
DATA  PIRAD/57. 29578/ 

IF(KFLAG.NE.l)  GO  TO  3 

SUBROUTINE  TO  READ  EMITTER  TARGET  AND  AIRCRAFT 
NAVIGATION  DATA  FROM  CARD  DATA  DECK 
DATA  SEQUENCE  MUST  BE  OF  FORMAT  TGT/NAV 

,  DO  1  1=1,100 
NUM=I-1 

READ  EMITTER  TARGET  DATA 

READ(  5,48,END=8)  TGT,  TIMET(I)  ,BRNGD(  I)  ,PRF(  I )  ,  PW  ( I  )  , 
1FRE0CI ) 

READ  AIRCRAFT  NAVIGATION  DATA 

READ(5,48)HDGD(I ), ACLAMDl I ),ACLOMD( I),ALT( I) ,VELN( I ) , 
1VELF( I ) 

CONT  INUE 

SUBROUTINE  TO  COMPUTE  AIRCRAFT  VELOCITY 

DO  2  1=1. NUM 

VELS  =  VFLE(  I  )*#2+VELN(I  )«-2 

VEL( I )=SQRT(VELS) 

SUBROUTINE  TO  CHANGE  ANGLES  FROM  DEGREES  TO  RADIANS 
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c 
c 
c 
c 


HDG(  I)=HDGD(  D/PIRAD 
BRNG( I ) =BRNGD(  I ) /PI  RAD 
CONT  INUE 


GFNFRATE     RANDOM    NOISE 
ANGLES    OF    ARRIVAL    AND 


TO    ADD    TO    K 
AIRCRAFT    PO 


NOWN    EMITTER    BEARING 
SITION    FIXES. 


6 

7 

48 
49 


50 

51 

201 


202 


IXE=5.<' 

IXN=7-M 

DO   4    I  = 

CALL    GA 

AMEANT= 

VARIT  =  V 

THETADC 

THETAt  I 

IF(THET 

IF(THET 

CALL    GA 

AMEANE= 

VARIE=V 

ACLODd 

ACLQRd 

CALL    GA 

AMFANN= 

VARIN=V 

ACLAD(  I 

ACLAR(  I 

CONT INU 

DEVNT=S 

DEVNE^S 

DEVNN=S 

IF(KFLA 

IFCKFLA 

WRITE(6 

WRITE! 6 

V,THETA 

VELNd  ) 

WRITE( 6 

WRITE(6 

1=1, NUM 

WRITEl 6 

KFLAG=K 

RETURN 

FORMAT ( 

FORMAT! 

2X,F8.5 

F3.1  ) 

FORMAT ( 

'LONGIT 

FORMAT  ( 

FORMATf 

•AIRCRA 

,37X,  'A 

•  PRF 

'  SLAD 
FORMATf 
•ARRIVA 
//.5X, 

•  =     i  ,f 

'ADDED 
10X,    «s 
END 


IX 
X 

1  ,  NU 

usst 

AMEA 
ARIT 
I  )  =  B 
)=TH 
A(I  ) 
AD(  I 
USS( 
AMEA 
ARIE 
)=AC 
)=AC 
USS( 
AMEA 
ARIN 
)=AC 
)=AC 


M 

IX,  STDEV,AMEAN,V) 

NT+V/NUM 

+  V?:-2/NUM 

RNGDt I )+V 

ETAD{  D/PIRAD 

.GT. 6. 283186)     THETAt 

).GT. 360.0)    THETADd 

IXEtSTQEVN, AMEAN,V> 

N5+V/NUM 

+Vt--  2 /NUM 

L3MD(  D+V/600. 

LOD( I )/PIRAD 

IXNt STOEVN, AMEAN.V) 

NiM+V/NUM 

+  V!--  2/NUM 

LAMD(  I  J+V/600. 

LAD( I ) /PIRAD 


I )=THETA( I ) 
)=THETAD(  I  )■ 


•6.283186 
■360.0 


CRT 

QRT 

ORT 

G.E 

G.N 

,20 

,49 

D(  I 

,VF 

,  50 

,  51 

) 

,  20 

FLA 


(VARIT) 

(VARIE) 

(VARIN) 

O.NRUN)     GO    TO    6 

E.l)     GO    TO    7 

1) 

)( I .TIMET (I) ,FREQ(I) , 

) , HDGDII ) ,ACLAMD( I ) ,A 

LE(I 

) 

)  (AC 


I  =  1 ,  NU  M  ) 
;LAMD(  I),  ACLAD<  I)  , 


2JAMEANT.DEVNT.AMEANE 
G+l 


6F11.5) 

•     •  , I3,2X,F5.1,2X,F6.1,2 

,2X,F9.5,2X,F5.1,2X,F8.5 


PRFd  )  ,PW(I  J.BRNGDl  I  ), 

CLOMDd)  ,ALT(I)  , 


ACLOMDd  )  , ACLODd  )  , 
,DEVNE,AMEANN,DEVNN 


X,F5.1,2X,F4.2,2X,F9.5, 
t2XtF10.5f2X.2F8. It 


«  L 

t  . 


3X, 
UDE 
4F11. 
'  1«  ,3 

FT    NA 
IRCRA 
PW 

///, 
L'  ,/, 
■NOIS 
5.2, 
TO  LA 
IGMA 


ATITUDE       NOISY    LAT       LONGITUDE       NOISY    « 

/) 

5) 

6X 

VI 
FT 


, « LISTING  OF  EMIT 
GATICN  DATA' ,///, 
PARAMETERS' .//, • 
BRNGD        V 
SLOD        ALT 
5X,  'NOISE  ADDED  T 
lOX.'MEAM  =  ' ,F5.2, 
E  ADDED  TO  LONGITUD 
/,  10X,  'SIGMA  =  ■ , 
TITUDE  FIXES'.  /,  1 
=  ',  F5.2,///) 


TER  TARGET  DATA  AND  «, 
13X, 'TARGET  PARAMETERS' 

JSET  TIMET    FREO    «, 
THETAD      HDGD   ', 

VELN    VELE',//) 
0  BEARING  ANGLES  OF  « . 
/,10Xt* SIGMA  =  « ,F5.2, 
E  FIXES' ,/,  10X,'MEAN' , 

F5.2,  //  ,  5X,  'NOISE 


OX 


MEAN 


F5.2,  /t 
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c .  . 

c 

C      SUBROUTINE  READ 

C 

C      SUBROUTINE  TO  READ  ACTUAL  AIRCRAFT  PECM  MISSION  TAPES 

C 


C 
C 


SUBROUTINE  READ(NUM) 

C 

C    SUBROUTINE  TO  READ  EMITTER  TARGET  AND  AIRCRAFT 

C    NAVIGATION  DATA  FROM  CARD  DATA  DECK 

C    DATA  SEQUENCE  MUST  BE  CF  FORMAT  TGT/NAV 

C 

C 

C 

COMMON    ACLAD(IOO)  , ACLAMD( 100 ) ,  AC LAR ( 1 00)  ,ACL0D(100) * 
1ACLOMD(100),ACLOR(100),ALT(100),BRNG(100),BRNGD(100), 
2E(100),FREQ(1C0),G1(100),G2(100) , GATE (100) , HDG(IOO), 
3HDGD( 100).M0DEN< 100) ,MODET( 100 ) , NST ( 100) , P 1 1 ( 100) , 
4P12Q0Q) ,  P22( 100 ), PITCH { 100) , PR F( 100), PW( 100), 
5  ROLL ( lOO).SLA(lOO) ,SLAD( 100) ,SL0{100),SLCC(100), 
5T( 100) .TIM EN (100). TIMET ( 100) , TDTD ( 1 00) , THTD( 100 ) , 
6THTDK100)  ,THETA(100)  ,  THET  AD  ( 100  ) ,  TL  AD(  100  )  , TLOD(  100 ) 
7VEL(  100),VELE(  100)  , VELN ( 100) ,XTD( 100 )  ,  YTD ( 100  )  , 
8D1H100  ), JST1100  ) 


DATA    PIRAD/57. 29578/ 


WRITE(6.53) 

DO    1    1=1,100 

NUM=I-1 
C  TYPE=11.0       EMITTER    TARGET    DATA 

READ( 5. 51. END=2) TGT, TIMETt I ) ,8RNG( I) ,PRF( I) ,  MODETU ) , 
i  pj.j/i  i     FREO(I) 
C  TYPE=7.0     ""AIRCRAFT    NAVIGATION    DATA 

RFAD(5.52)    NAV , T IMEN ( I ) , MODEN ( I ) , ALT ( I ) , AC LAR ( I ) ,       - 
lACLORd  ) 

READ(5,  56)HDG(  I  )  ,VELE(I  )  ,VELN(I  )  ,ROLL(  I)  ,  PITCHU  ) 

WRITE (6, 54) I.TIMETC I ), FREOt I ) ,BRNG( I) ,PRF< I) ,PW(I ) , 
1M0DET( I) 

WRITE( 6,  55) TIM  EN (I  )  ,HCG( I)  ,ALT(I )  ,ACLAR( I )  ,ACL0R(I) , 
1 VELNCI J.VELEU ), ROLL! I ),PITCH( I ) ,MODEN( I ) 
C 

C    SUBROUTINE  TO  COMPUTE  AIRCRAFT  VELOCITY 
C 

VELS=VELE(I)^2  +  VELN(  I  )**2 

VEL(I)=SORTCVELSJ 
1    CONTINUE 
C 

C    SUBROUTINE  TO  CHANGE  ANGLES  AND  LATITUDE/LONGITUDE 
C    FROM  RADIANS  TO  DEGREES  +  TENTHS  OF  DEGREES 
C 
2     DO  5  J=1,NUM 

HDGD( J  )  =  HDG(J)v<PIRAD 

BRNGD( J)=BRNG(  J)'-  PI  RAD 

AC  LAD (  J)=ACLAR{  J)"- PI  RAD 

ACLOD( J  )=ACLOR(  J  )-:'PIRAD 

ACLAMD{ J)=ACLAD{ J ) 

ACLOMD( J)=ACLOD( J) 

THETAJ  J)=BRNG(  J)+HDG( J) 

IF (THET A ( J ) .GT .6.283186)  THETA ( J ) =THETA ( J )-6. 2831 86 

THETAD( J)=BPNGD(J)+HDGD(J) 

IF(THETAD(J) .GT. 360.0)  THE TAD( J ) =THETAD ( J ) -360.0 
5    CONTINUE 

51  F0RMAT(7F11.5) 

52  F0RMAT(6F13.5) 

53  FORMAT ( ' 1« ,36X. « LISTING    OF    EMITTER    TARGET    DATA    AND    ', 
l'AIRCRAFT    NAVIGATION    DATA ',///, 13X ,« TARGET    PARAMETERS' 
2  ,37X, "AIRCRAFT     PARAMETERS',//,'     TYPE  TIME',4X, 
3«FRE0            BRNG            PRF          PW       MO    /    TIME               HDG  ALT', 
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46X,'LAT  LONG  N.VEL  E.VEL  ROLL  PITCH' 

5,2X, «MO« ,// ) 

54  FORMATC     TGT'  , I  3 , 1 X , F9 .3 , IX , F6  .1 , IX , F7 . 5 , IX , F6 . 1,  IX, 
1F4.2.  IX,  II  ) 

55  FORMATC     NAV  •  ,43X,  F9 . 3, IX , F7 . 5, IX, F7.  1,  IX, F 8. 5, IX, F 8. 5 
11X.F8.3,1X,F3.3,1X,F8.5,1X,F8.5,1X,F3.0,/) 

56  FGRMAT  (5F13.5) 
RETURN 

END 
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